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Currently  industrial  robot  manipulators  operate 
slowly  to  avoid  dynamic  interactions  between  links. 
Typically  each  joint  is  controlled  independently  and  system 
stability  and  precision  are  maintained  at  the  expense  of 
underutilizing  these  systems.   As  a  result,  productivity  is 
limited,  and  more  importantly,  the  lack  of  reliability  has 
hindered  investment  and  wider  industrial  use.   This  work 
addresses  the  adaptive  control  of  spatial,  serial 
manipulators.   Centralized  adaptive  controllers  which 
yield  globally  asymptotically  stable  systems  are  designed 
via  the  second  method  of  Lyapunov.   Actuator  dynamics  is 
also  included  in  the  system  model. 

Lagrange  equations  are  used  in  deriving  dynamic 
equations  for  n-link,  spatial  robot  manipulators  which  are 
modeled  with  rigid  links  connected  by  either  revolute  or 
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prismatic  pairs.   Although  manipulators  may  exhibit 
structural  flexibility,  the  rigid  link  assumption  is 
justified,  because  control  of  manipulators  needs  to  be 
understood  precisely  before  flexibility  is  included.   The 
plant,  which  represents  the  actual  manipulator,  and  the 
reference  model,  representing  the  ideal  robot,  are  both 
expressed  as  distinct,  nonlinear,  coupled  systems. 
Error-driven  system  dynamics  is  then  written  and  adaptive 
controllers  which  assure  global  asymptotic  stability  of  the 
system  are  given  utilizing  the  second  method  of  Lyapunov. 
It  is  shown  that  these  control  laws  also  lead  to 
asymptotically  hyperstable  systems. 

Integral  feedback  is  introduced  to  compensate  for 
the  steady-state  system  disturbances.   Tracking  is  achieved 
since  the  error-driven  system  is  used  in  deriving  the 
controllers.   Manipulator  dynamics  is  expressed  in  hand 
coordinates  and  an  adaptive  controller  is  suggested  for 
this  model.   Actuator  dynamics,  modeled  as  third-order, 
linear,  time-invariant  systems,  is  coupled  with  manipulator 
dynamics  and  a  nonlinear  state  transformation  is  introduced 
to  facilitate  the  controller  design.   Later,  simplified 
actuator  dynamics  is  presented  and  the  adaptive  controller 
design  and  disturbance  rejection  feature  are  extended  for 
this  system.   Adaptive  controllers  are  implemented  on  the 
computer,  and  numerical  examples  on  3-  and  6-link  spatial, 
industrial  m.anipulators  are  presented. 
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CHAPTER  1 
INTRODUCTION  AND  BACKGROUND 


In  this  chapter,  manipulator  description  and  general 
problems  associated  with  this  class  of  systems  are  addressed 
and  the  previous  work  in  this  area  is  briefly  reviewed. 
The  review  mainly  concentrates  on  the  dynamics  development 
and  control  of  manipulators.   After  an  introduction  to 
general  control  stages,  background  on  the  lowest  level 
control,  the  so-called  executive  level,  is  presented.   This 
presentation,  in  turn,  groups  the  previous  work  under 
optimal  control,  control  schemes  utilizing  linearization 
techniques,  nonlinearity  compensation  methods,  and  adaptive 
control  of  manipulators. 

1.1  Manipulator  Description  and  Related  Problems 
A  robotic  manipulator  is  defined  as  a  system  of 
closed-loop  linkages  connected  in  series  by  kinematic 
joints  which  allow  relative  motion  of  the  two  linkage 
systems  they  connect.   One  end  of  the  chain  is  fixed  to  a 
support  while  the  other  end  is  free  to  move  about  in  the 
space.   In  this  way  an  open-loop  mechanism  is  formed.   If 
each  closed-loop  linkage  system  consists  of  a  single  link, 
then  a  simple  serial  manipulator  will  be  obtained. 
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Currently,  most  industrial  manipulators  are  serial  arms  due 
to  their  simpler  design  and  analysis. 

A  robotic  manipulator  system  is  defined  as  a 
programmable,  multifunction  manipulator  designed  to  move 
material,  parts,  tools  or  specialized  devices  through 
variable  programmed  motions  for  the  performance  of  a  variety 
of  tasks  without  human  intervention.   In  the  literature,  the 
terms  robotic  manipulator,  mechanical  arm,  manipulator, 
artificial  arm,  robotic  arm  and  open-loop  articulated  chain 
are  used  interchangeably. 

Manipulators  find  numerous  practical  applications  in 
industry  [5,  51,  58]*  and  their  use  is  justified  mainly  for 
their  dedication  on  repetitive  jobs  and  for  their  flexibility 
against  hard  automation.   Tesar  et  al.  detail  the  handling 
of  radioactive  material  via  robotics  implementation  to  a  fuel 
fabrication  plant  in  [52] .   Positioning/recovery  of 
satellites  in  space  with  the  NASA  Space  Shuttle  Remote 
Manipulator  System — though  not  completely  successful  yet — is 
another  challenging  application  area  of  robotics. 

In  the  analysis  of  manipulators, basically  two 
problems  are  encountered.   The  first  is  called  the 
positioning  or  point-to-point  path-follov/ing  problem  and 
can  be  stated  as  follows:   Given  the  desired  position  and 


*Numbers  within  brackets  indicate  references  at  the  end 
of  this  text. 
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orientation  of  the  free  end  of  the  manipulator,  i.e.,  hand 
(or  gripper)  of  the  manipulator,  find  the  joint  positions 
which  will  bring  the  hand  to  the  desired  position  and 
orientation.   This  kinematics  problem  involves  a  nonlinear 
correspondence  (not  a  mapping)  of  the  Cartesian  space  to 
the  manipulator  joint  space. 

If  a  serial  manipulator  is  modeled  with  n  rigid 
links  and  n  one  degree-of-f reedom  joints,  then  the  dimension 
of  its  joint  space  will  be  n.   In  Cartesian  space,  six 
independent  coordinates  are  needed  to  describe  uniquely  the 
position  and  orientation  of  a  rigid  body.   Now,  for  n  =  6  ,  a 
finite  number  of  solutions  can  be  obtained  in  the  joint 
space  except  at  singular  points  [49].   Closed-form  solution 
to  this  problem  is  not  available  for  a  general  manipulator. 

Duffy  instantaneously  represents  a  6-link,  serial 
manipulator  by  a  7-link,  closed-loop  spatial  mechanism  with 
the  addition  of  a  hypothetical  link  and  systematically 
solves  all  possible  joint  displacements  [9].   Paul  et  al. 
obtain  closed-form  solution  for  the  Puma  arm  (Unimate  600 
Robot)  [40];  their  method  is  not  general,  but  applicable 
to  some  industrial  manipulators.  In  practice,  however, 
some  industrial  arms  make  use  of  iterative  methods  even  in 
real  time. 

When  n  <  6  ,  joint  space  cannot  span  the  Cartesian 
space.   In  general,  the  gripper  cannot  take  the  specified 


position  and  orientation.   And  finally,  if  n  >  6,  the 
manipulator  v;ill  be  called  redundant.   In  this  case, 
infinitely  many  solutions  may  be  obtained  and  this  feature 
lends  the  current  problem  to  optimization  (e.g.,  see  [31]). 

Whitney  was  the  first  to  map  hand  command  rates 
(linear  and  angular  hand  velocities)  into  joint  displacement 
rates,  known  as  coordinated  control  or  resolved  rate  control 
[63] .   This  transformation  is  possible  as  long  as  the 
Jacobian  (defined  in  Chapter  4,  Section  4.2.2)  is 
nonsingular.   If  the  Jacobian  is  singular,  the  manipulator 
is  then  said  to  be  in  a  special  configuration.   In  these 
cases,  there  is  not  a  unique  set  of  finite  joint  velocities 
to  attain  the  prescribed  hand  velocity.   In  today's  practice, 
however,  special  configurations  of  industrial  manipulators 
are  mostly  ignored.   Later,  related  work  concentrated  on 
the  derivation  of  efficient  algorithms  [41,  59]. 

The  second  problem  includes  dynamic  analysis  and 
control  of  manipulators  and  can  be  stated  as  follows:   Find 
the  structure  of  the  controller  and  the  inputs  which  will 
bring  the  manipulator  to  the  desired  position  and 
orientation  from  its  present  configuration.   If  optimization 
is  introduced  with  respect  to  some  criterion  to  improve 
the  system  performance,  then  it  is  called  an  optimal  control 
problem. 

Basic  tasks  performed  by  industrial  manipulators  can 
be  classified  in  two  groups.   The  first  group  tasks  include 
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pick-and-place  activities  such  as  spot  welding,  machine 
loading  and  unloading  operations, and  can  be  treated  as  a 
reaching-a-target  problem.   In  this  problem  initial  and 
terminal  positions  are  specified,  but  the  path  followed 
between  these  two  configurations  is  in  general  of  no 
importance  except  for  obstacle  avoidance.   Optimization  can 
be  introduced  to  synthesize  optimal  control  and  obtain 
corresponding  optimal  paths.   Typically,  minimization  of 
time,  energy,  input  power,  etc.,  or  any  combination  of 
these  indices  will  improve  manipulator  performance  with 
respect  to  these  criteria.   The  second  group  tasks  include 
continuous  welding  processes,  metal  cutting,  spray  painting, 
automatic  assembly  operations,  etc.  and  require  tracking 
(contouring)  of  a  specified  path.   The  present  work 
basically  considers  the  tracking  problem. 

1.2   Dynamics  Background 
If  the  manipulator  is  to  be  moved  very  slowly,  no 
significant  dynamic  forces  will  act  on  the  system.   However, 
if  rapid  motions  are  required,  dynamic  interactions  between 
the  links  can  no  longer  be  neglected.   Currently  servo- 
controlled  industrial  manipulators  ignore  such  interactions 
and  use  local  (decentralized)  linear  feedback  to  control  the 
position  of  each  joint  independently.   At  higher  speeds  the 
system  response  to  this  type  of  control  deteriorates 
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significantly,  even  instability  can  be  induced.   Hence, 
dynamic  effects  have  to  be  included  in  the  mathematical 
model  and  compensated  for  to  obtain  smooth  and  accurate 
response.   This  has  been  the  main  motivation  for  researchers 
to  work  on  the  dynamics  of  manipulators  for  almost  20  years. 
In  1965,  Uicker  was  the  first  to  derive  dynamic  equations 
of  general  closed-loop  spatial  chains  using  Lagrange 
equations  [55] .   In  the  same  year.  Hooker  and  Margulies 
applied  the  Newton-Euler  formulation  to  multi-body 
satellite  dynamics  [20].   Later,  in  1969,  Kahn  and  Roth 
were  the  first  to  obtain  equations  of  motion  specifically 
for  open-loop  chains  using  the  Lagrangian  approach  [22]. 
Stepanenko  and  Vukobratovic  applied  the  Newton-Euler  method 
to  robotic  mechanisms  in  1976  [46] . 

Even  the  derivation  of  closed-form  dynamic 
equations  for  two  6-link  manipulators  was  considered  to 
be  an  achievement  in  the  field,  as  referenced  in  [64] . 
Since  these  equations  are  highly  nonlinear,  coupled,  and 
contain  a  relatively  large  number  of  terms,  later  work 
concentrated  on  computer  implementation  and  numerical 
construction  of  dynamic  equations.   Then,  solutions  to  both 
forward  and  inverse  problems  were  obtained  numerically  on 
digital  computers.   Since  then  numerous  techniques  have 
been  developed  to  find  efficient  algorithms. 

Hollerbach  derived  recursive  relations  based  on  the 
Lagrangian  approach  [19].   Orin  et  al.  [37],  Paul  et  al . 


[39],  and  Luh  et  al.  [34]  gave  efficient  algorithms  using 
the  Newton-Euler  formulation.   Thomas  and  Tesar  introduced 
kinematic  influence  coefficients  in  their  derivation  [53] . 
In  a  series  of  papers  [37,  43,  46,  56],  Vukobratovic  et  al. 
derived  the  dynamic  equations  using  different  methods. 
Later,  Vukobratovic  gathered  this  work  in  [57] .   Walker  and 
Orin  compared  the  computational  efficiency  of  four 
algorithms  in  forming  the  equations  of  motion  (for  dynamic 
simulation)  using  the  recursive  Newton-Euler  formulation 
[60] .   Featherstone  used  screw  theory  in  the  derivation  of 
dynamic  equations  and  gave  various  algorithms  for  the  forward 
and  inverse  problems  [10] . 

The  main  goal  in  these  studies  vas  to  compute  the 
dynamic  effects  in  real  time.   Efficient  software  coupled 
v\?ith  the  revolutionary  developments  in  microprocessors, 
today,  almost  achieved  this  goal.   Use  of  array  processors 
in  real  time  dynamics  evaluation  was  studied  in  [61]. 

1.3   Previous  Work  on  the  Control  of  Manipulators 
1.3.1   Hierarchical  Control  Stages 

In  the  next  stage,  questions  concerning  the  control 
of  manipulators  are  raised.   The  following  control  levels 
are  frequently  mentioned  in  the  literature  [45,  58] : 

1.  Obstacle  Avoidance  and  Decision  Making 

2.  Strategical  Level 

3.  Tactical  Level 

4 .  Executive  Level 


Obstacle  Avoidance  and  Decision  Making,  or  the 
so-called  highest  level  control,  basically  lends  itself  to 
Artificial  Intelligence.   Here,  the  ultimate  goal  is  to 
reproduce  and  build  human  intuition,  reasoning,  and  reaction 
into  machines.   Although  that  goal  has  not  been  achieved  yet, 
limited  subproblems  have  been  solved  mostly  with  the  use  of 
vision  systems  and  sensor  technology.   Currently,  the 
human  himself  has  to  make  almost  all  intelligent  decisions 
to  operate  industrial  manipulators.   The  Strategical  Level 
receives  information  from  the  first  level  and  generates 
consistent  elementary  hand  movements,  whereas  the  motion  of 
each  degree  of  freedom  of  the  manipulator  is  decided  for  each 
given  elementary  motion  in  the  Tactical  Level.   The 
Executive  Level,  in  turn,  executes  the  Tactical  Level 
commands . 

It  should  be  noted  that  the  second  and  third  control 
levels  involve  only  the  kinematics  of  manipulators  and  that 
it  is  at  the  fourth  level  that  all  dynamic  effects  are  taken 
into  account  in  the  control  of  manipulators.   In  the  following 
review,  the  lowest  level  of  control,  the  so-called  Executive 
Level,  is  considered. 

Position  control  of  serial  manipulators  is  studied 
in  a  variety  of  ways.   Due  to  the  complex  structure  of  the 
system  dynamics,  most  approaches  assume  rigid  links, 
although  some  manipulators  may  exhibit  structural  flexi- 
bility.  The  rigid  link  assumption  is  justified,  because 


the  dynamics  and  control  of  rigid  manipulators  need  to  be 
understood  precisely  before  the  flexible  case  can  be  solved 
[12,  58].   Also,  external  disturbances  are  almost  always 
neglected.   Actuator  dynamics  is  usually  not  taken  into 
account;  rather,  actuators  are  represented  by  their 
effective  torques/forces  acting  at  each  joint.   These 
torques/forces  may  be  generated  by  electrical,  hydraulic, 
or  pneumatic  motors;  however,  in  all  cases  they  cannot  be 
assigned  instantaneously;  thus  such  models  are  not 
physically  realizable. 

Very  few  works  in  the  literature  include  actuator 
dynamics  in  the  mathematical  model.  In  [38],  actuator 
torques  are  assumed  to  be  instantaneously  controllable,  but 
approximation  curves  are  used  to  account  for  the  loading 
effects  and  friction  of  the  actuators.   Electric  and 
hydraulic  motors  are  represented  by  linear,  time-invariant, 
third-order  models  in  [7,  13,  58]. 

1.3.2   Optimal  Control  of  Manipulators 

Synthesis  of  optimal  trajectories  for  a  given  task 
(reaching-a-target  problem)  has  been  studied  by  several 
researchers.   Kahn  and  Roth  [22]  presented  a  suboptimal 
numerical  solution  to  the  minimum-time  problem  for  a  3-link 
manipulator.   The  dynamic  model  was  linearized  by  neglecting 
the  second-  and  higher-order  terms  in  the  equations  of  motion, 
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but  the  effects  of  gravity-  and  the  velocity-related  terms 
were  represented  by  some  average  values. 

The  maximum  principal  has  also  been  employed  to 
solve  the  optimal  control  problem  [54,  58] .   Power-time 
optimal  trajectories  are  determined  in  [54] ,  whereas  the 
quadratic  performance  index  is  chosen  in  [58].  Unfortunately, 
this  method  is  hampered  mainly  because  of  the  dimensionality 
of  the  problem.   With  the  introduction  of  2n costate  variables, 
4n  (24  for  6-link,  6  degree-of-f reedom  manipulator)  nonlinear, 
coupled,  first-order  differential  equations  are  obtained  for 
an  n-link — here  also  n  degree-of-f reedom — manipulator, 
without  considering  the  actuator  dynamics.   If  initial  and 
terminal  conditions  are  specified  for  the  manipulator,  then 
a  two-point  boundary  value  problem  will  result.   The 
solution  to  this  problem,  even  on  a  digital  computer,  is 
quite  difficult  to  obtain.   An  interesting  feature  in  [54] 
is  that  a  numerical  scheme  is  proposed  to  obtain  optimal 
solutions  for  different  initial  conditions. 

In  [18] ,  a  quadratic  performance  index  is  chosen  in 
terms  of  the  input  torques  and  the  error  from  a  given 
nominal  state.   Dynamic  equations  of  manipulators  are  not 
linearized,  but  error-driven  equations  are  written  about 
the  nominal  state.   The  open-loop  optimal  control  problem 
is  then  solved  using  a  direct  search  algorithm.   Later, 
optimal  control  is  approximated  by  constant-gain,  linear 
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state  feedback  resulting  with  suboptimal  control.   The 
proposed  feedback  controller  is  invalid,  however,  if  the 
deviation  of  the  manipulator  state  from  the  given  nominal 
state  is  large.   This  method  is  applied  to  a  2-link 
manipulator. 

Optimum  velocity  distribution  along  a  prescribed 
straight  path  is  studied  using  dynamic  programming  [24]. 
Several  optimum  path  planning  algorithms  are  developed  for 
the  manipulator  end-effector.   Typically,  total  traveling 
time  is  minimized  while  satisfying  the  velocity  and 
acceleration  constraints  [32,  33,  39].   Actually  this  is  a 
kinematics  problem  and  since  the  geometric  path  is  specified 
in  advance,  it  does  not  solve  the  optimal  positioning 
problem. 

1.3.3   Control  Schemes  Using  Linearization  Techniques 

For  the  closed-loop  control  of  manipulators, 
linearization  of  manipulator  dynamics  has  been  examined  by 
several  authors.   In  this  approach,  typically,  dynamic 
equations  are  linearized  about  a  nominal  point  and  a  control 
law  is  designed  for  the  linearized  system.   But  numerical 
simulations  show  that  such  linearizations  are  valid  locally 
and  even  stability  of  the  system  cannot  be  assured  as  the 
state  leaves  the  nominal  point  about  which  linearization 
has  been  conducted. 
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Golla  et  al .  [12]  neglected  the  gravity  effects 
and  external  disturbances,  and  linearized  the  dynamic 
equations.   Then,  closed-loop  pole  assignability  for  the 
centralized  and  decentralized  (independent  joint  control) 
linear  feedback  control  was  discussed. 

In  [47,  58]  spatial,  n-link  manipulators  with  rigid 
links  are  considered.   In  general,  6-link  manipulators  are 
treated,  but  some  examples  use  n  =  3  which  is  termed  as 
"minimal  manipulator  configuration"  within  the  text  [58] . 
Most  approaches  make  use  of  the  linearized  system  dynamics. 
Independent  joint  control  (local  control)  with  constant 
gain  feedback  and  optimal  linear  controllers  are  designed 
for  the  linearized  system.   Force  feedback  is  also 
introduced  in  addition  to  the  local  control  when  coupling 
between  the  links  is  "strong"  (global  control) .   However, 
numerical  results  for  example  problems  show  mixed  success 
and  depend  on  numerical  trial-and-error  techniques. 

Kahn  and  Roth  linearized  the  dynamic  equations  of  a 
2-link  manipulator  and  designed  a  time-suboptimal  controller 
in  [22]  .   Since  the  linearized  model  was  only  valid 
locally,  he  concluded  that  average  values  of  the  nonlinear 
velocity-related  terms  and  gravity  effects  had  to  be  added 
to  the  model  to  guarantee  suboptimality . 

Whitehead,  in  his  work  [62] ,  also  linearized  the 
manipulator  dynamics  and  discretized  the  resulting  equations 
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sequentially  at  nominal  points  along  a  specified  state 
trajectory.   Then,  linear  state  feedback  control  was  applied 
to  each  linearized  system  along  the  trajectory.   An 
interesting  aspect  of  this  work  was  the  inclusion  of  the 
disturbance  rejection  feature  in  the  formulation.   Later,  a 
numerical  feedback  gain  interpolation  scheme  was  proposed 
and  applied  to  a  3-link,  planar  manipulator.   Yuan  [67] 
neglected  the  velocity  related-terms  and  the  gravity  loads, 
and  then  linearized  the  remaining  terms  in  the  equations  of 
motion.   Later,  he  proposed  a  feedforward  decoupling 
compensator  for  the  resulting  linearized  system. 

In  general,  once  the  manipulator  dynamics  is 
linearized,  all  the  powerful  tools  of  linear  control  theory 
are  available  to  design  various  controllers.   However, 
since  almost  all  practical  applications  require  large 
(and/or  fast)  motions,  as  opposed  to  infinitesimal  movements 
of  manipulators,  linear  system  treatment  of  robotic  devices 
cannot  provide  general  solutions.   Even  a  global  stability 
analysis  cannot  be  conducted.   If  the  worst-case  design 
is  employed  for  some  special  manipulators,  this  in  turn 
will  result  with  the  use  of  unnecessarily  large  actuators, 
hence,  waste  of  power. 

1.3.4   Nonlinearity  Compensation  Methods 

Another  approach  in  the  literature  uses  nonlinearity 
compensation  to  linearize  and  decouple  the  dynamic  equations. 
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Such  compensation  is  first  used  in  [16]  for  the  linearization 
of  2-link  planar  manipulator  dynamics.   In  this  method, 
typically,  the  control  vector  is  so  chosen  that  all 
nonlinearities  in  the  equations  are  canceled.   Obviously, 
under  this  assumption  and  with  the  proper  selection  of 
constant  gain  matrices,  a  completely  decoupled, 
time-invariant,  and  linear  set  of  closed-loop  dynamic 
equations  can  be  obtained  [11,  13,  17,  35,  67]. 

All  nonlinear  terms  in  the  control  expression  are 
to  be  calculated  off-line  [11].   Hence,  a  perfect 
manipulator  which  is  "exactly"  represented  by  dynamic 
equations  and  infinite  computer  precision  are  assumed 
[5].   On-line  computation  of  nonlinear  terms  is  proposed 
in  [17],  but  the  scheme  requires  (on-line)  inversion  of 
an  n  X  n  nonlinear  matrix  other  than  the  calculation  of  all 
nonlinear  effects.   Generation  of  a  look-up  table  is 
suggested  in  [13] ,  but  dimensionality  of  the  problem  makes 
this  approach  impractical.   This  scheme  is  applied  only 
to  1-  and  2-link  planar  manipulators  in  [13]. 

Again,  since  the  stability  analysis  of  the  resulting 
locally  linearized  system  is  not  sufficient  for  the  global 
stability  of  the  actual,  nonlinear  system,  these  approaches 
do  not  provide  general  solutions  to  the  manipulator  control 
problem. 
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Several  other  controllers  have  also  been  designed. 
Force-f edback  control  of  manipulators  is  studied  in  [65]. 
Proposed  diagonal  force-feedback  gain  matrix  uses  the 
measured  forces  and  generates  modified  command  signals. 
This  method  is  simple  for  implementation,  but  gains  must  be 
selected  for  each  given  task  and  affect  the  stability  of 
the  overall  system.   Variable  structure  theory  is  used  in 
the  control  of  2-link  manipulators  [68],   However,  the 
variable  structure  controller  produces  an  undesirable, 
discontinuous  feedback  signal  which  changes  sign  rapidly. 
Centralized  and  decentralized  feedback  control  of  a  flexible, 
2-link  planar  manipulator  is  examined  in  [4] . 

1.3.5   Adaptive  Control  of  Manipulators 

Although  the  work  on  adaptive  control  theory  goes 
back  to  the  early  1950s,  application  to  robotic  manipulators 
is  first  suggested  in  the  late  1970s.   Since  then  a  variety 
of  different  algorithms  has  been  proposed.   Dubowsky  and 
DesForges  designed  a  model  reference  adaptive  controller 
[8] .   In  their  formulation,  each  servomechanism  is  modeled 
as  second-order,  single-input,  single-output  system, 
neglecting  the  coupling  between  system  degrees  of  freedom. 
Then,  for  each  degree-of-f reedom,  position,  and  velocity 
feedback  gains  are  calculated  by  an  algorithm  which 
minimizes  a  positive  semi-definite  error  function  utilizing 


16 


the  steepest  descent  method.   Stability  is  investigated  for 
the  uncoupled,  linearized  system  model. 

Takegaki  and  Arimoto  proposed  an  adaptive  control 
method  to  track  desired  trajectories  which  were  described 
in  the  task-oriented  coordinates  [50]  .   Actuator  dynamics 
is  not  included.   In  this  work,  an  approximate  open-loop 
control  law  is  derived.   Then,  an  adaptive  controller  is 
suggested  which  compensates  gravity  terms,  calculates  the 
Jacobian  and  the  variable  gains,  but  does  not  require  the 
calculation  of  manipulator  dynamics  explicitly.   However, 
nonlinear,  state  variable  dependent  terms  in  the  manipulator 
dynamic  equations  are  assumed  to  be  slowly  time-varying 
(actually  assumed  constant  through  the  adaptation  process) 
and  hence  manipulator  hand  velocity  is  sufficiently  slow. 
Although  this  assumption  is  frequently  made  in  several  other 
works  [1,  8,  21,  48,  66],  it  contradicts  the  premise,  i.e., 
control  of  manipulators  undergoing  fast  movements. 

In  [21]  adaptive  control  of  a  3-link  manipulator  is 
studied.  Gravity  effects  and  the  mass  and  inertia  of  the 
first  link  are  neglected.  Also,  actuator  dynamics  is  not 
considered.  Each  nonlinear  term  in  the  dynamic  equations 
is  identified  a  priori,  treated  as  unknown,  and  estimated 
by  the  adaptation  algorithm.  Then,  the  manipulator  is 
forced  to  behave  like  a  linear,  time-invariant,  decoupled 
system.   For  the  modeled  system  and  the  designed  controller. 
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stability  analysis  is  given  via  Popov's  hyperstability 
theory  [26,  27,  28,  42].   Recently,  Anex  and  Hubbard 
experimentally  implemented  this  algorithm  with  some 
modifications  [1] .   System  response  to  high  speed  movements 
is  not  tested,  but  practical  problems  encountered  during 
the  implementation  are  addressed  in  detail. 

Balestrino  et  al.  developed  an  adaptive  controller 
which  produces  discontinuous  control  signals  [3] .   This 
feature  is  rather  undesirable,  since  it  causes  chattering. 
Actuator  dynamics  is  not  included  in  the  formulation. 
Stability  analysis  is  presented  using  hyperstability 
theory.   Stoten  [4  8]  formulated  the  adaptive  control 
problem  and  constructed  an  algorithm  closely  following  the 
procedures  in  [29] .   Manipulator  parameters  are  assumed  to 
be  constant  during  the  adaptation  process  and  the  algorithm 
is  simulated  only  for  a  1-link  manipulator. 

Lee  [30]  expressed  the  dynamics  in  the 
task-oriented  coordinates,  linearized  and  then  discretized 
the  equations  without  including  the  motor  dynamics.   All 
parameters  of  the  discretized  system  (216  for  6-link 
manipulator)  are  estimated  at  each  sampling  time  using  a 
recursive  least  squares  parameter  identification  algorithm. 
Optimal  control  is  then  suggested  for  the  identified  system. 
Stability  analysis  is  not  given  in  this  work.   The  main 
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drawback  in  this  adaptive  control  scheme  is  the  large  number 
of  the  parameters  to  be  identified.   In  general,  all 
estimation  methods  are  poorly  conditioned  if  the  models 
are  overparameterized  [2];  here  the  whole  model  is 
parameterized.   Koivo  and  Guo  also  used  recursive  parameter 
estimation  in  [25]. 

1.4   Purpose  and  Organization  of  Present  Work 
In  this  work,  trajectory  tracking  of  serial,  spatial 
manipulators  is  studied.   The  plant  (manipulator)  and  the 
reference  model,  which  represents  the  ideal  manipulator, 
are  both  described  by  nonlinear,  coupled  system  equations, 
and  the  plant  is  forced  to  behave  like  the  reference  model. 
This  is  achieved  via  the  second  method  of  Lyapunov,  and  it 
is  shown  that  the  proposed  controller  structures  are 
adaptive.   All  the  previous  works  known  to  the  author 
typically  choose  a  time-invariant,  decoupled,  linear  system 
to  represent  the  reference  model,  and  force  the  nonlinear 
plant  to  act  like  the  linear  reference  model. 

Due  to  the  nonlinear  and  coupled  nature  of  the 
manipulator  dynamics,  most  of  the  works  fail  to  supply  a 
sound  stability  analysis  in  studying  the  dynamic  control 
of  manipulators.   Design  of  controllers  in  this  study  is 
based  on  the  global  asymptotic  stability  of  the  resulting 
closed-loop  systems.   Implementation  of  controllers  in  hand 


coordinates  and  inclusion  of  actuator  dynamics  are  also 
addressed. 

The  mathematical  model  of  n-link,  spatial,  serial 
manipulators  with  adjacent  links  connected  by  single 
degree-of -freedom  revolute  or  prismatic  joint  pairs  is 
presented  in  Chapter  2 .   Dynamic  equations  are  derived 
using  the  Lagrange  equations.   Various  definitions  of 
adaptive  control  are  reviewed,  and  the  design  of  adaptive 
control  laws  utilizing  the  second  method  of  Lyapunov  is 
given  in  Chapter  3.   Basic  definitions  of  stability  and  the 
main  theorems  concerning  the  second  method  of  Lyapunov  are 
also  included  in  this  chapter  to  maintain  continuity. 
Following  a  brief  introduction  to  hyperstability ,  it  is 
shown  that  the  globally  asymptotically  stable  closed-loop 
systems  are  also  asymptotically  hyperstable. 

In  Chapter  4,  manipulator  dynamics  is  expressed  in 
hand  coordinates  and  an  adaptive  controller  is  proposed  for 
this  system.   As  pointed  out  earlier,  inclusion  of  actuator 
dynamics  is  essential  in  application,  since  actuator 
torques  cannot  be  assigned  instantaneously.   Actuator 
dynamics  is  coupled  with  the  manipulator  dynamics  in 
Chapter  5.   Each  actuator  is  represented  by  a  third-order, 
time-invariant,  linear  system  and  the  coupled  system 
equations  are  formed.   Then,  a  nonlinear  state 
transformation  is  introduced  to  facilitate  the  controller 
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design.   Simplified  actuator  dynamics  is  also  introduced 
which  modeled  each  actuator  as  a  second-order, 
time-invariant,  linear  system.   It  is  shown  that  the 
controllers  given  in  Chapter  3  can  be  extended  for  these 
systems.   A  disturbance  rejection  feature  is  also  added 
through  integral  feedback. 

Chapter  6  presents  the  computer  simulations 
performed  on  3-link,  spatial  and  6-link,  spatial  industrial 
(Cincinnati  Milacron  T3-776)  manipulators.   Effects  of  poor 
manipulator  parameter  estimations,  controller  implementation 
delays,  measurement  delays  and  the  integral  feedback  on 
system  response  are  illustrated.   Finally,  the  conclusions 
derived  from  this  work  are  summarized  in  Chapter  7. 
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CHAPTER  2 
SYSTEM  DYNAMICS 


2.1   System  Description 

In  this  study  n-link,  spatial,  serial  manipulators 
are  considered.   Adjacent  links  are  assumed  to  be  connected 
by  one  degree-of-freedom  rotational,  revolute  or 
translational,  prismatic  joints.   This  assumption  is  not 
restrictive,  since  most  kinematic  pairs  with  higher  degrees 
of  freedom  can  be  represented  by  combinations  of  revolute 
and  prismatic  joints.   Hence,  an  m  degree-of-freedom 
kinematic  pair  may  be  represented  by  m,  revolute  and  m- 
prismatic  joints,  where  m  =  m,  +  m-. 

The  mathematical  model  also  assumes  that  the 
manipulator  is  composed  of  rigid  links.   Actually, 
manipulators  operating  under  various  payloads  and  external 
forces  experience  structural  deflection.   In  addition, 
transient  phenomena  such  as  system  shocks  introduce 
vibrations  in  the  small  which  are  low  magnitude,  oscillatory 
deformations  about  the  mean  motion  equilibrium. 

However,  inclusion  of  deflection  effects  in  the 
formulation  increases  the  model  dimensionality  and  further 
complicates  the  system  dynamics.   It  should  be  noted  that  the 
dynamic  equations  of  rigid-link  manipulator  models  are 
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highly  nonlinear,  coupled,  and  contain  a  relatively  large 
number  of  terms  and  that  currently  industrial  manipulators 
completely  ignore  the  nonlinear  and  coupling  effects  in 
their  control  schemes.   Hence,  here  the  rationale  is  first 
to  understand  precisely  and  solve  the  control  problem  for 
manipulators  with  rigid  links  and  then  include  deformations 
in  the  formulation  in  later  steps.   Also,  possible  backlash 
at  joints  and  connecting  gear  systems  are  not  included  in 
the  mathematical  model. 

Link  j  is  powered  by  an  actuator  mounted  on  link 

( j-1) ,  j  =  l,2,...,n.   Here  the  0    link  is  the  ground  or  the 
support  to  which  the  manipulator  is  secured,  the  n    link 
is  the  outermost  link  in  the  chain  which  will  be  called 
the  hand  or  gripper  of  the  manipulator.   Initially  actuator 
dynamics  is  omitted  and  the  effects  of  actuators  are 
represented  by  their  resultant  torques  x .  applied  by  the 

(j  -  1)    link  on  the  j    link;  that  is,  actuator  torques 
are  considered  to  be  the  control  variables.   Again,  this 
model  is  not  realizable,  since  actuator  torques  cannot  be 
assigned  instantaneously.   However,  this  model  is  still  used 
because  of  its  simplicity  for  the  proposed  control  law 
presentation.   Later,  various  actuator  models  are  presented, 
their  dynamics  are  coupled  with  the  manipulator  dynamics, 
and  it  is  shown  that  the  developed  control  laws  can  be 
extended  for  this  system. 
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Aside  from  deformation,  v/hich  is  also  payload 
dependent,  and  backlash,  most,  if  not  all,  currently 
available  industrial  robot  arms  can  be  represented  with  the 
proposed  manipulator  model. 

2.2   Kinematic  Representation  of  Manipulators 
Associated  with  each  one  degree-of -freedom  joint  i, 
joint  axis  is  defined  by  unit  vector  s.,  i  =  1,2, ...,n. 
For  revolute  joints,  joint  variable  (f) .  (relative  joint 
rotation)  is  measured  about  s..   Joint  variable  s.  (offset 
distance)  is  measured  along  s.  for  prismatic  joints. 
Obviously,  if  the  k   joint  is  revolute,  then  the 
corresponding  offset  distance  Sj^  will  be  constant.   In  order 
to  distinguish  the  joint  variables  from  constant  manipulator 
parameters,  constant  offset  distances  are  denoted  by  double 

subscripts  s^^^^  for  all  revolute  joints.   Similarly,  if  the 

th  .  .  ^  .     .    ^.      ,   . 
m   ]oint  IS  prismatic,  relative  :)oint  rotation  will  be 

denoted  by  4)   v/hich  is  constant. 

In  order  to  represent  the  joint  variables 

independent  of  the  manipulator  joint  sequence,  these 

variables  are  compactly  given  by  an  n-dimensional  generalized 

joint  variable  vector  Q_   for  an  n  degree-of-f reedom  robot 

manipulator.   Consider  an  n  degree-of-f reedom  arm  with  its 

links  connected  by  revolute-prismatic-revolute- .. .-revolute 

(RPR...R)  joints  sequentially.   For  this  arm,  generalized 

joint  variable  vector  9_  will  then  be  given  by 
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Link  j  connects  the  j    and  (j  +  1)    joints  and 

it  is  identified  by  its  link  length  r .  and  the  twist  angle 

a.  as  depicted  in  Figure  2.1.   Note  that  according  to  this 

convention r  can  be  chosen  arbitrarily  and  a„  is  not  defined 
n  n 

for  the  last  link — the  hand  of  the  manipulator. 


^k  =  "j+1 


Figure  2.1  Link  Parameters  r.  and  a. 
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•''^'A ,  ■,_■;•; 
In  Figure  2.1,  s.,  s,  ,  and  r.  are  unit  vectors  and  ■;■ 

r.  is  the  perpendicular  distance  between  joint  axes  s.  and 

s,  .   Hence,  associated  with  each  link  j,  unit  vector  r.,        .  v.*.-"' 

and  with  each  joint  j,  unit  vector  s.  are  defined,  where 

For  a  manipulator  of  n  links,  (n  +  1)  dextral 
reference  frames  are  defined.   Manipulator  parameters  and 
reference  frames  are  shown  in  Figure  2.2.   Fixed  reference 


i-{0)  -(0)  -(0)1 
tors  ^u^   ,U2   ,u^  y 


frame  F^.  defined  by  the  basis  vectors  ^u^   ,u^   ,u-j   r  ^^ 
attached  to  the  0    link,  the  ground;  u^    lying  along  s, . 
Orientation  of  u,    and  U2    is  arbitrary.   One  dextral, 

body-fixed  reference  frame  F .  is  also  attached  to  each  link 

f-  (i)  - (1)  -  (1) 
j.   Frame  F.  is  defined  by  its  basis  vectors  iu-,   /^o  '^1 

-(i).    ,        .   .-■      ■    ,     ^  -,-(i)   .,- 

u,    IS  chosen  coincident  with  r.  and  u-,-^   with  s.; 
1  3       3         J 

j  =  1,2, ... ,n. 

If  a  vector  a  is  expressed  in  the  j    reference 
frame,  its  components  in  this  frame  will  be  given  by  a 
column  vector  a  -'  .   If  the  superscript  (j)  is  omitted, 
i.e.,  a,  it  should  be  understood  that  the  vector  is  expressed 
in  the  ground-fixed  F„  frame.   Now,  it  is  important  to  note 
that  the  unit  vectors  r .  and  s .  expressed  in  their  body-fixed 
frame  F.  will  have  constant  representations  given  by 

rf^^  =  (10  0)"^   and   sf^^  =  (0  0  1)''^       (2.1) 


Figure  2.2  Kinematic  Representation  of  Industrial  Manipulator 
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Let  a  be  a  given  vector.   Again,  a  -'   and  a  will 
represent  expressions  of  a  in  frames  F.  and  F„,  respectively, 
Transformation  relating  a  -'   to  a  is  given  by 


a  =  T  .a 


(J) 


(2.2) 


Recognizing  that  r.  =  T.r:^  ,  s.  =  T.sp  ,  that  u^^^  is 
given  by  s.  xr.  and  using  Equation  (2.1),  it  can  be  shown 
that  transformation  T.  is  given  by 


T.  = 


r  . 

-J 


s  .  X  r  . 


s  . 
-3 


(2.3) 


Noting  that  T,  is  given  by 


^1  = 


cos6,     -sine,     0 


sin0. 


cose. 


(2.4) 


r .  and  s .  can  be  determined  recursively  from 


r  .  =  T  .  , 

-1         :-i 


cose 


cosa  ._-,   •  sine  . 


sina 


J-1 


sinf 


(2.5) 


and 
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s  .  =  T  .  , 


-sma 


J-1 


cosa 


J-1 


j  =  2  , 3  , 


,n 


(2.6) 


The  reader  is  referred  to  [54]  for  a  detailed  treatment  of 
successive  rotations  of  rigid  bodies  in  space. 

2.3   Kinetic  Energy  of  Manipulators 
2.3.1   Kinetic  Energy  of  a  Rigid  Body 

Consider  a  rigid  body  which  is  both  translating  and 
rotating.   Let  Fq  be  a  fixed  reference  frame  defined  by  the 

-  (0)     -  (0)        ^   -  (0)      .   ^  „    t,  r: 

unit  vectors  u,   ,  u^   ,  and  u '   .   Let  F^  be  a  reference 
12  3  p 

frame  fixed  to  the  body  at  its  center  of  gravity  C.   Let 

^(p)   '^(p)     -,  -^(p) 
the  unit  vectors  defining  F   be  u,   ,  u-   ,  and  u^"^  . 

Reference  frames  are  depicted  in  Figure  2.3,   Let  also  S  be 

an  arbitrary  point  of  the  body.   One  can  write 


z   =  z   +  p 
s    c    '^ 


(2.7) 


V   =v   +aj,„xp 
s     c     p/0 


(2.8) 


where  w  ,„  is  the  angular  velocity  of  F  with  respect  to  Fq, 

V  ,  and  V   are  the  linear  velocities  of  the  related  points, 
s       c 

The  kinetic  energy  (KE)  of  the  body  can  be  expressed 
as  follows: 


KE  = 


m 


TT  V  .V  dm 
2   s     s 
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u 


(o) 


u 


(p) 


Figure  2.3   Reference  Frame  F  Fixed  on  a  Rigid  Body 


where  m  is  the  mass  of  the  body.   Kinetic  energy  can  also  be 
expressed  as 


^  m 


+  (iip/Q  xp)  .  (^p^Q  xp)]    dm 


(2.9) 


Noting  that,  since  C  is  the  center  of  gravity, 


p  dm  =  0 


'm 


(2.10) 


.-_».-<»*  .  >, 


Thus, 
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KE  =  ^  m  v^  .  v^  +  i  j^  ( VO  "  P)  •  ( VO  '  ^^  ^ 


or 


(2.11) 


1  -    -     1 

2  c    c    2 


m 


^p/0   ^p/0 


(2.12) 


where  f^  is  a  dyadic  formed  by  the  components  of  co  ,_  such 
that 


(q) 

a;ij,p/o 


k-1   ^ 


(q) 

kj  "^k,p/0 


(2.13] 


where  the  superscript  (q)  denotes  the  components  expressed 
in  an  arbitrary  frame  F  ,  and 


+1,  if  ikj  is  a  permutation  of  123* 


e.,  .  =  --1,  if  iki  is  a  permutation  of  321 
ik:)  -'      ^ 


(  0,  if  any  two  of  ikj  are  equal 


Note  that  ^     ,„ 

%p/o 


-Q  ,„  is  the  transpose  of  fi  ,.,.   Hence, 


•{123,  231,  312}  is  meant, 


31 


KE  = 


^  m  V  •  V 
2     c    c 


^   J^         %p/o  ^P/0 


(2.14) 


On  the  other  hand,  it  can  be  shown  that 


^p/0   ^p/0      p/0    p/0   :x,    p/0   p/0 


where  I  is  the  identity  dyadic,  i.e.,  I  -r 


=  r.   Then 


1  ^    ^     1  - 

2  c    c    2   p/0 


(p  •  p  I  -  pp)  dm 


m 


'\j 


p/0 


(2.16) 


]_    ^    ^     1  '^         ^ 
KE  =  ^  m  V  •  V   +  T-  0)  ,„  •  J  •  Oi}^  /^ 
2     c    c    2   p/0   ^    p/0 


(2.17) 


where  J  is  defined  as  the  moment  of  inertia  dyadic,  i.e., 


J  = 
'\j        J 


(p  •  p  I  -  pp)  dm 


(2.18; 


m 


Note  that,  since  p  is  fixed  in  F  ,  components  of  the  matrices 
j^^'    =  J  and  p^   =  p  will  be  independent  of  time,  and 


T         T 
J  =  I   (£  £  I  -  _pp_  )  dm 

m 


(2.19; 
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where  I  is  a  3x3  identity  matrix.   Furthermore,  if  the 
unit  vectors  of  frame  F   are  along  the  principal  axes,  the 
matrix  J  will  be  diagonal,  i.e.. 


J  = 


^1 

0 


(2.20) 


where 


^i  = 


m 


T      2 
(p_  £  -  pj_)  dm;  i  =  1,2,3 


The  kinetic  energy  of  the  rigid  body  can  be  given  as 


_  _  1  ^  ^{0)1      (0)  ^1   (p)  ^   (d) 
2    — c     — c      2  — p/0    — p/0 


(2.21) 


The  rigid  body  described  above  can  be  considered  to 
be  the  i    link  of  the  manipulator,  i  =  1,2, ...,n.   Then  the 
kinetic  energy  expression  for  this  link  becomes 


1      (0)T   (0)  ^  1   (i)T  ^    (i) 

KE .  =  T-  m .  V      V  +  T-  CO .  ,'  J .  to .  ,' 

1    2   1  — c .    -c .     2  —1/0  1  —1/0 

11  ' 


(2.22) 


where 


m.  is  the  mass  of  the  i    link 

1 


■^?5 


33 


V    xs  the  three-dxmensional  column  vector 
— c . 

1 

describing  the  absolute  linear  velocity  of 
the  center  of  gravity  of  the  i    link 
expressed  in  the  fixed  Fq  frame 

w./i  is  the  absolute  angular  velocity  of  the  i 
link,  expressed  in  the  i    frame  F., 
three-dimensional  column  vector 

J.  is  the  3x3  inertia  matrix  of  the  i    link 

1 

at  the  center  of  gravity  C.  expressed  in 

the  frame  F . 

1 

Total  kinetic  energy  of  an  n-link  manipulator  will  then  be 


n 
KE  =   y   KE.  ■  (2.23] 

i=l    ^ 


Expressions  for  the  absolute  linear  velocity  of  the 

center  of  gravity  v ^ .   and  the  absolute  angular  velocity 

0).  /i.  are  derived  in  the  following  sections. 
—1/0 

2.3.2  Absolute  Linear  Velocities 
of  the  Center  of  Gravities 

Let  a  manipulator  of  n  links  be  given  displacements 

e,,9^,...,e  .   Orientation  of  the  i    link,  1  ^  i  <  n,  can 
1 '  2'    '  n 

be  considered  to  be  the  result  of  i  successive  rotations; 
the  resulting  rotation  is  denoted  by  Rot:  Fq  — >-F.  .   If  a  is 
a  vector  undergoing  these  rotations,  then 


.>^ 
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a""  =T.a'i' 

—  1— 


(2.24) 


where  T.  is  as  given  by  Equation  (2.3). 

Now,  let  C.  be  a  fixed  point  in  link  i.  Position 
vector  Zq.  connecting  the  origin  of  frame  F  to  point  C.  is 
given  by 


.  =  ^1^1  -^  J^  ^^k-1  ^k-1  +  ^k^k^  ^  K./o. 

1  k=2  1   1 


(2.25) 


where  Zc-/0  ^^   ^^®  position  vector  connecting  the  origin  of 
frame  F.,0.,  to  point  C,  and 


^°/o.  =  ^i  ^^/O. 


(2.26) 


Differentiating  Equation  (2.25),  absolute  linear  velocity  of 
point  C.,V(-..,  is  obtained  as  follows: 


V 


'i   j=l 


3  .  S  .  +  (()  .  S  .  X 

J       J  3       3 


k=]+l 


^  ^k  ^k^  ^  ^c./O. 


(2.27) 
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or 


1 
-i=i  ->     ->        J  J    x'  : 


where  Zc-/0-  ^^  ^^®  position  vector  from  the  origin  0.  of 
frame  F.  to  point  C.  and  given  by 


z   /r,=z    -z„=    )    (r,  ,r,  , 
c./O.     c.     0.    ,  h,,         k-1   k-1 
±3  1     D    k=j+l 


+  ^k  =k)  ^  V/0.  (2-29) 


It  is  understood  that  constant  offset  distance  s,^   will  be 
inserted  in  Equations  (2.25),  (2.27),  and  (2.29)  for  Sj^-if 
the  k    joint  is  revolute.   Position  vectors  defined  above 
are  illustrated  in  Figure  2.4.   It  should  also  be  noted  that 
in  Equation  (2.28)  s.  is  zero  if  the  j    joint  is  revolute; 
(|)  .  is  zero  if  it  is  prismatic.   Equation  (2.28)  can  be 
represented  in  vector-matrix  form  as 


^.  =  ^c°^  =   ^c.  ^  (2.30) 

11       1 


where 


d9 

^  =  dt 


.  •^. 
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u. 


(i) 


u 


(i) 


Figure  2.4   Illustration  of  Position  Vectors 


G   e  R  ^^,  its  j    column  defined  by 
c . 

X 


[G^ J  .  =  -  s. 


=  i  3 


-j^^./O-/  j<i  and  j  """  joint  revolute 


th  . 

I 

.th 


-3 
0 


,  j  <i  and  j   joint  prismatic 
,  otherwise 


(2.31) 
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where  0^  denotes  a  three-dimensional  null  column  vector. 

3  ^n 
For  an  n-link  RRPRP . . .  arm,  G   eR    for  example,  will  take 

C4 

the  form 


%  =  t^l^^4/0^   -2^^4/02   -3   -4'V04  -'"- 


Thomas  and  Tesar  defined  these  position-dependent  terms 
[G^.] .  as  translational  first-order  influence  coefficients 
[53]  . 

Now,  considering  that  the  arbitrarily  chosen  point 
C.  actually  represents  the  center  of  gravity  of  the  link  i, 
linear  absolute  velocity  of  link  i  is  then  given  by  Equation 
(2.28)  or  Equation  (2.30)  . 


2.3.3   Absolute  Angular  Velocities  of  Links 

Absolute  angular  velocity  of  link  i  is  given 
by 


Vo    ^   ''l/O    ""    ^"2/1   +    •••    +    Vl/i-2    ^    '^i/i-l 


(2.32) 


'"i/O   =    <J>i    s^    +    (})    82    +    ...    +    *._!    s._^    +    d).    s. 

(2.33) 

Recalling  Equation  (2.24),  any  vector  a  can  be  expressed  in 
frame  F.,  provided  that  its  representation  in  frame  Fq  and 
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the  related  transfoirmation  matrix  T.  are  given.   The  reverse 
of  this  transformation  is  also  always  possible,  since  the 
transformation  represented  by  T .  is  orthogonal.   Hence, 


^(i)  =  T-1  a(°)  =  T^  a(°) 


(2.34) 


Rewriting  Equation  (2.32)  in  vector-matrix  form 


(0) 


-i/O   -i/O    .4^  ^j   -J 


(2.35) 


or 


(0) 

CO.  /'  =  G.  oj 
—1/0     1  — 


(2.36) 


where  the  j    column  of  G.  eR    is  defined  as 


[G,] .  =  i 


r 


s . ,  j  <  i  and  i    joint  revolute 
-3      ^  J 

0  ,  otherwise 


(2.37) 


Using  Equation  (2.34),  '^■/n    can  also  be  expressed  in  frame 


„(i)  _  rT,T  ,  (0) 

^i/0  -  ^i  ^i/0 


(2.38) 


(i)     r   :   T^  s. 
3  =  1 


(2.39) 
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or  in  more  compact  form 


—1/0     1    — 


(2.40) 


where  the  j   column  of  G.   e R  ^^  is  now  defined  by 


1  'j 


T.  s.,  i  <  i  and  i    joint  revolute 

1  _j  '  -J  -> 

0     ,  otherwise 


Similar  G.  matrices  are  used  in  [53]  and  termed  as 

1 

rotational  first-order  influence  coefficients. 


2.3.4   Total  Kinetic  Energy 

Total  kinetic  energy  expression  for  an  n-link 
manipulator  follows  from  Equations  (2.22)  and  (2.23) 


(2.41) 


KE=   ?   |m.  v^^^^v^^^ 
.  ^  -,       2      1  — c  .    — c  . 
1=1  -       1      1 


^  1   (i)T  ^    (i)" 
2  — i/O    1  —1/0 


(2.42; 


Absolute  linear  velocities  of  the  center  of  gravities  v^ 
and  the  absolute  angular  velocities  w.^q  are  determined  as 
linear  functions  of  the  generalized  joint  velocities  oj  within 
the  previous  sections.   Substituting  Equations  (2.30)  and 
(2.40)  into  Equation  (2.42),  the  kinetic  energy  expression 
becomes 


M 
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KE  = 


1  T 

2  —      ^ 


n 


y   [m-c'^   G    +  g:^^*^  J.  G.^ 

.^-.IC.    C.       1        1    1 

1=1 


(i) 


1     X 


'     CO 


Defining 


(2.43) 


n 


=.   I   [n,,  G^   G^   +G|i'''  J,  G,'i'l 
i=l       i    i 


1   1 


(2.44) 


Equation  (2.43)  becomes 


1  T 

KE  =  -;r  0)    A    (JJ 

2  -   p  - 


(2.45) 


where  A     =  A    (9_)    is   an   n  xn    symmetric,    positive     definite, 

tr       P 

generalized  inertia  matrix  of  the  manipulator  [54]. 


2.4   Equations  of  Motion 
Equations  of  motion  will  be  derived  using  the 
Lagrange  equations  which  are  given  by 


_d_ 
dt 


8KE 


duii 


3KE 


=    Q, 


(2.46; 


where 


9,,  k  =  1,2, ...,n  are  the  generalized  coordinates 


d0, 


0),   = 


k    dt 


■M 
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KE  =  KE  (9_,w)  =  KE  (  0,  ,  9- ,  •  •  •  ,  9  /  w,  ,  CO2  /  •  •  •  f  (^j^) 
is  the  kinetic  energy  of  the  manipulator. 


and 


Q,  is  the  generalized  force  associated  with 
the  k   generalized  coordinate 

Derivation  of  the  generalized  force  expressions  is 
given  in  the  following  section.   Once  these  expressions  for 
Q,  are  obtained,  dynamic  equations  of  the  manipulator  will 
directly  follow  from  Equation  (2.46), 

2.4.1   Generalized  Forces 

The  expressions  for  generalized  forces  Q,  are  derived 
by  subjecting  all  generalized  coordinates  6,  to  virtual 
displacements  5  9,  and  forming  the  virtual  work  expression.         '  .  • 
The  coefficients  of  6  9,  's  in  this  expression  constitute 
the  generalized  forces  by  definition. 

Now,  let  all  the  externally  applied  forces  acting 
on  link  i  be  represented  by  the  resultant  force  f . ,  and 
all  moments  acting  on  the  same  link  by  m . .   Here,  it  will 
be  assumed  that  f.  acts  through  point  C.  in  link  i.   This 
point  can  represent  any  point  in  the  link,  however,  for  ,;' 

the  current  presentation,  restriction  of  point  C.  to  be  the 
center  of  gravity  of  the  i    link  will  suffice. 

Virtual  work  6W  done  by  the  force  f .  and  mom.ent  m.         r':A 

1  1  '■  «•';■; 

is  given  by  ■■■  -'• 


t^: 


J 
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1    c.        1    1/0 


(2.47) 


where  the  virtual  displacement  of  link  i  is  w.  ,„  6t  and  that 
of  point  C.  is  6Zj,.  =  Vc  •  (St.   Representing  vectors  in 
frame  F-,  Equation  (2.47)  becomes 


6W  =  f   G    0)  6t  +  m.  G.  oj  6t 
— 1   c  .  —       —11  — 

1 


(2.48) 


where  G^  •  and  G-^  are  as  defined  by  Equation  (2.30)  and 
Equation  (2.35),  respectively.  Letting  6W,  denote  the 
resulting  virtual  work  due  only  to  the  variation  in  0,  , 


^\  =  Qk  «\ 


(2.49) 


and 


6W,  = 
k 


f^ 

— 1 


[G^.] 


+  m. 
k   -1 


1  k 


69, 


(2.50) 


where  [G^-]]^  is  given  by  Equation  (2.31)  and  [G.],  by 
Equation  (2.37).   Hence,  generalized  force  Q,  is  given  by 


Qk  =  il  f^ci^k  ^  51-  [G.]^ 


(2.51) 


If  external  effects  are  represented  by  gravity  loads, 
actuator  torques,  and  viscous  friction  at  the  joints,  then 
virtual  work  6W,  due  to  5  9,  will  be 


m 
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n 


^^\   =      I      ra.  g   .  6z 


j=k 


j  ^a    c.,e 


j'"k 


■^   66,  +  T,  59, 
3a),    k    k   k 


where 


(2.52) 


g   :  the  gravitational  acceleration 
a 

vector 


""j'^k      ^^k     ^ 


(2.53) 


T,  :  the  torque  applied  on  the  i    link  by 
the  (i-l)^'^  link 


3  r 

■s =   Yi     (jj,     where   Yi     is    the   coefficient  of 

8co.    'k   k        'k 

viscous  damping  at  the  k    joint  and 


^  "   ^   2  ^i  '^i 
i=l  ^   1   1 


(2.54) 


r  is  the  Rayleigh's  dissipation  function.   Similarly, 


6W,  = 
k 


^.I^m.  g^  [G,.],^  -    y^-K^    ^k[  ^\   (2.55) 


Thus,  related  generalized  force  will  be 


Qk  =  .1   ^  ia  f^cJk  -  ^k  '^k  •"  "k  (2.56: 


j=k 
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Note  that  Equations  (2.52),  (2.55),  and  (2.56)  ass\aiTie  that 

the  payload  is  included  in  the  mass  of  the  last  link  m  . 

n 

Payload  or  any  other  external  effect  can  be  separately 
represented  in  the  formulation  as  given  by  Equation  (2.51) . 
Defining 


^k=  \   ^j   ia  f^c.^k  (2.57) 


the  generalized  force  Q,  becomes 


Qk  =  ^k  -  Yk  ^k  ^  ^k  (2.58) 


where 


'^y.   "  9j^(i)  r  k  =  1,2,  ...  ,n 

2.4.2   Lagrange  Equations 

Total  kinetic  energy  expression  in  Equation  (2.45) 
can  be  written  in  indical  notation,  repeating  indices 
indicating  summation  over  1  to  n. 


KE  =  J  A     oj^  CO.  (2.59) 

^ij 

Ap .  .  denotes  the  element  (i,j)  of  the  generalized  inertia 

matrix  A  .   Then, 
P 

I =^(A     oj.6.,+A     CO.  6.,)  (2.60) 

^^k       Pij   ^   ^^     Pij  ^      ^^ 


■  t 


where 


or 
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fl  if  i  =  k 


'ik 


0  if  i  7^  k 


(2.61) 


|M  =  1  (A     03   +  A^    CO.) 


(2.62) 


Since  A   is  symmetric, 
P 


3KE 

=  A     CO  . 

303^^     Pki   ^ 


(2.63) 


Introducing  Equations  (2.63),  (2,45),  and  (2.58)  into 
Equation  (2.4  6) 


3^  <V-  "i' 

^  ki 


2  ^67^  ^i  ^j 


^k  -  Yk  ^k  +  "^k 


(2.64) 


Noting 


■^    (A     CO.)  =  A^    CO.  +  A 
dt    p^.   1 


CO  . 


Pki  ^     Pki  ^ 


where  (')  represents  differentiation  with  respect  to  time 
and 


■'^f. 
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3A_ 


^ki 


Xi     3^3   "^ 


(2.65) 


Equation  (2.64)  becomes 


^      0).  + 

Pki   ^ 


3A. 


^ki 


36 


1  ^ 
2 


i: 


30, 


1   3 


=  5k  -  ^k  '"k  ^  ^k 


(2.66) 


Defining 


3A 


3A_ 


^  _  1    ^ij 
k 


ijk     36.     2   3 


(2.67) 


where  D*  -    [D* .,  ]  c   r^^^^"^  equations  of  motion  are  given 
by 


\,    '^i  +  °ijk  '^i  ^j  =  ^k  -  ^k  ^k  ^  \     ^2-^^^ 


Now,  D*.,  can  be  replaced  by  D.  .,  ,  D  =  [D.  .,  ]  ,  such  that 


D..,  OJ.  CO.  =  D..,  to.  0). 
ijk   1   J     ijk   1  2 


(2.69) 


holds  [53] ;  D. .,  is  defined  by 
ijk  -^ 


^ijk^'^^  tH^jlj  t^cjk^  f«£^l:  ^£  fSJk 


-^  f^^^i:  'i  (t^^k  ^  f^^j^ 


(2.70) 


where 
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[H^  ] 


[G_  ] 


c^  i,j    96^    c^  j 


(2.71) 


[H   ]  .  . 


s.  X  (s^.  X  z   ,^  )  ,  i  <  j  <  il; 


i,j  revolute 


s  .  X  s  . 

-3      -1 


s  .  X  (s  .  X  z   ,„  )  ,  j  <i  <  ii; 
J     ^   ~^£^  i 


i,j  revolute 

,  j  <  i  <  £  ; 

i  prismatic, 
j  revolute 

,  i  <  j  <  a  ; 

i  revolute, 
j  prismatic 

,   otherwise 


s  .    X  s  . 

-1      -J 


■:^» .  -r 


^1 


(2.72; 


[HJ. 


[GJ 


£ '  i  ,  j         3  0^.         £ 


(2.73) 


fVi,j 


s.    xs.,    i<j^£;    i,j    revolute 


,  otherwise 


(2.74) 


■'•'-■■*'S 
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[G   ]^  is  given  by  Equation  (2.31)  and  [G,],  by  Equation 
(2.37).   H.  and  H^   are  called  second-order  rotational  and 
translational  influence  coefficients  [53]  .   Again,  the 


repeated  index  I   in  Equation  (2.70)  indicates  summation 
over  1  to  n.  Also  defining  D,  e  T? 


\   "  ^°ij^k  "  ^°ijk^ '  ^'^  "  1,2,. ..,n      (2.75) 


with  D. .,  as  given  by  Equation  (2.70),  dynamic  equations 

1]K 


finally  take  the  form 


Pki   ^ 


00^  =  -  w   Dt,  w  -  Yv  f^v  +  ^k  +  ^k 


-  ^k  -   'k  "-k 


JC  —  X^^/»««fil 


(2.76) 


or 


A   w  =  - 

P  — 


T 


-    2  - 


CO   D   0) 
—    n  — 


-  [y]    to  +  g  +  T 


(2.77) 


where 


^  =  %(i)'  \  =  V-^ 


M 
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[y]  e  R     is  the  diagonal  matrix  containing 
the  coefficients  of  viscous 
friction 

2.  ~  2.(§.)  ^  ^      denotes  the  equivalent 

gravitational  torques  due  to  the 
mass  content  of  the  system  as  seen 
at  the  joints 


T_  e  R   represents  the  actuator  driving 
torques 


^ 


CHAPTER  3 
ADAPTIVE  CONTROL  OF  MANIPULATORS 


3.1   Definition  of  Adaptive  Control 

According  to  Webster's  dictionary,  to  adapt  means 

"to  adjust  (oneself)  to  new  circumstances."   Adaptive 

control,  then,  in  essence,  is  used  to  mean  a  more 

sophisticated,  flexible  control  system  over  the  conventional 

feedback  systems.   Such  a  system  will  assure  high 

performance  when  large  and  unpredictable  variations  in  the 

plant  dynamic  characteristics  occur. 

In  the  literature,  however,  a  common  definition  of 

,-■;  ■     adaptive  control  is  still  missing.   Astrom  defines  adaptive 

^-.;^''       control  as  a  special  type  of  nonlinear  feedback  control  [2]  . 

Hang  and  Parks  give  the  definition  for  model  reference 

adaptive  control  as  follows: 

The  desirable  dynamic  characteristics  of  the 
plant  are  specified  in  a  reference  model  and 
the  input  signal  or  the  controllable  parameters 

■^  .  of  the  plant  are  adjusted,  continuously  or 

discretely,  so  that  its  response  will  duplicate 
that  of  the  model  as  closely  as  possible.   The 

'■  identification  of  the  plant  dynamic  performance 

,;•"  is  not  necessary  and  hence  a  fast  adaptation 

can  be  achieved.   [15,  p.  419] 

Landau  defines 

An  adaptive  system  measures  a  certain  index  of 
performance  using  the  inputs,  the  states,  and 
■,  the  outputs  of  the  adjustable  system.   From  the 

comparison  of  the  measured  index  of  performance 
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and  a  set  of  given  ones,  the  adaptation  mechanism 
modifies  the  parameters  of  the  adjustable  system 
or  generates  an  auxiliary  input  in  order  to 
maintain  the  index  of  performance  close  to  the 
set  of  given  ones.   [29,  p.  13] 

Gusev,  Timofeev,  et  al.  [14]  include  artificial  intelligence 

and  decision  making  in  adaptive  control. 

In  this  study  adaptive  control  is  defined  as 

follows: 

Definition  3.1:   A  feedback  control  system  is 
adaptive,  if  gains  are  selected  with  the 
on-line  information  of  plant  outputs  and/or 
plant  state  variables  along  with  the  nominal 
(reference)  inputs,  nominal  outputs  and/or 
nominal  state  variables. 
This  definition  is  illustrated  in  Figure  3.1.   It 
should  be  noted  that  the  definition  given  here  is  in 
agreement  with  the  above  definitions;  it  is  more  specific 
than  Astrom ' s  and  more  general  than  Hang ' s  or  Landau ' s . 
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y 
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Output 
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-^ 

Regulator 

V 

^r 
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n 

1 

1 
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1 

Figxire  3.1   Block  Diagram  Representation  of 
an  Adaptive  Control  System 
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Early  works  on  adaptive  control,  which  were 
essentially  experimental,  date  back  to  the  1950s.   Later, 
advances  in  the  control  theory  in  1960s  and  the  recent 
revolutionary  developments  in  microelectronics  matured  the 
adaptive  control  theory  and  its  applications  considerably 
compared  to  its  early  stages. 

Mainly  three  approaches  are  identified  in  adaptive 
control:   Gain  Scheduling,  Model  Reference  Adaptive  Control 
and  Self -tuning  Regulators  (Parameter  Estimation  Techniques) 
Block  diagram  representations  of  these  schemes  are  given  in 
Figures  3.2-3.4. 


r 
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Figure  3.2   Block  Diagram  of  Gain  Scheduling  System 
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Figure  3.3   Block  Diagram  of  Model  Reference  Adaptive  System 
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Figure  3.4   Block  Diagram  of  Self -tuning  Regulator 
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All  these  block  diagrams  in  Figures  3.2-3.4  can  be 
reduced  to  the  block  diagram  in  Figure  3.1  simply  by 
shrinking  the  dotted  boxes  into  the  variable  regulator  in 
Figure  3.1. 

3.2   State  Equations  of  the  Plant 
and  the  Reference  Model 

3.2.1  Plant  State  Equations 

T    T  T 
Defining  the  state  vector  x  =  (6  ,  w  )   where 

6   e  r"  and  t^j   e  R"  are  the  generalized  relative  joint 

-P  -P 

displacement  and  velocity  vectors,  respectively,  dynamic 
equations  derived  in  the  previous  chapter  can  be  given  as 
follows : 


X   = 
-P 


A  "*•  G     a""""  F 

^    P      PI 


X   + 
-P 


0 
-1 


u 
-P 


(3.1) 


where  subscript  p  stands  for  "plant,"  here  manipulator 
represents  the  plant. 


X   =  X  (t) 
-P   -P 


,  T     T  >T  ^  p2n 
=  ^^pl'  ^p2)   ^  ^ 


(3.2: 


Xpi  =  ep(t),  Xp2  =  u.p(t) 


(3.3) 


=  — =  (>^„i  /  >^^t) 


dt 


^-pl'  -p2' 


(3.4) 
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I  and  0  denote  the  nxn  identity  and  null 
matrices,  respectively 

Referring  to  Equations  (2.76)  and  (2.77), 


P    P  -Pl 


nxn 


(3.5) 


q  (x,)  =Gx,  =G  (x,)x, 
!2-p'-pl'     p-pl     p  -pl  -pi 


(3.6) 


nxn 


G  =  G  (x  ,)  £  R"^'\   g^Cx^J  ^  R 


,n 


p    p  -pl 


^P^-Pl' 


(3.7) 


f  (x  ,,  x  -)  =  F^  x^^  =  F^(x^, ,  x^,)  X  ,     (3.8) 
^)  — pl   — p2     p  — p2    p  — pl  — p2  —p^ 


f   =  f  (x  ,  ,  X  t] 
-P   -P  -pl   -p2 


^p2    ^l^^pl^    ^p2 


X  -    D  (x  , )    x^T 
— p2     n  — pl     — P2_ 


e   R 


n 


(3.9) 


F   =  F  (x  ,  ,  X  -)  = 

P     P  -pl   -P2 


X  -,    D,  (x  ,  ] 
— p2     1  — pl 


X  o    D  (x  ,  ) 
— p2     n  — pl 


e  R 


nxn 


(3.io; 


u  =  u  (t)  =  T^(t)  e    R 
-P   -P      -P 


n 


(3.11) 
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T  (t)  represents  input  actuator  torques. 


n  is  the  number  of  links  of  the  manipulator 
(here  also  an  n-degree-of-f reedom 
manipulator) 


Note  that  A  ,  G  ,  and  F   are  not  constant;  A„  and  G^  are 

P   P       p  P      P 

nonlinear  functions  of  the  joint  variables  x  , ,  and 

F  =  F  (x  , ,  X  -) .   In  the  formulation,  functional 
P    P  -Pl   -P2 

dependencies  are  not  shown  for  simplicity.   Also,  G  (x  ,) 

is  not  defined  explicitly;  symbolically,  G  (x  ,)  is  such 

that  G  (x  ,)x  ,  =  g   holds.   External  disturbance  terms 
P  -pl  -pl   ^P 

and  the  joint  friction  effects  are  not  shown  in  the  above 
formulation. 

3.2.2   Reference  Model  State  Equations 

Having  defined  the  plant  equations — Equation 
(3.1) — reference  or  model  state  equations  which  represent 
the  ideal  manipulator  and  the  desired  response  are  given  by 


X   = 

— r 


0 


a"""-  g    a  ■'■  f^ 

r   r     r    r 


X   + 

— r 


0 
-1 


u        (3.12) 
— r 


where 


subscript  r  represents  the  "reference"  model 
to  be  followed, 
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X   is  the  state  vector  for  the  reference 
— r 

system 


X   =  X  (t) 
— r   — r 


,  T    T  ,T    o2n 


(3.13) 


Xrl  =  ij-^^^  ^  ^^'    -r2  "  ^r^^^  ^  '^^ 


(3.14) 


^r     dt     ^-rl'  -r2^ 


(3.15) 


Again,  referring  to  the  manipulator  dynamic  equations,  i.e.. 
Equations  (2.76)  and  (2.77), 


A  =  A  (x  ,  )  e  f^ri^ri  ^g  ^^^   generalized 
r    r  — rl  ^ 


inertia  matrix  for  the  reference 
system 


q  (x,)  =Gx,  =G  (x,)  X, 
■2-r  — rl     r— rl    r  -rl   — rl 


(3.16) 


^    ^    I         \    nHxn     ,    V    „n 
G^  =  G^(^rl^  ^  '^    '  2:r^^rl^  ^  '^ 


(3.17) 


^r^^rl'  ^r2^  =  ^r-r2  =   ^r^^rl'  ^r2^  ^r2     ^^-^^^ 


f     =   f    (X   T  ,    X   t)    = 

— r   — r  — rl   — r2 


X  ^  D,  (x  ,  )  X  T 
— r2   1  — rl   — r2 


^r2  °n^^rl^  ^r2 


£  R 


n 


(3.19; 
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F   =  F  (x  ,  ,  X  -)  = 
r    r  — rl   — r2 


^r2  ^l^^rl^ 


X  T  D  (x  ,) 
— r2   n  — rl 


e    R"^"  (3.20) 


It  is  important  to  note  that  A  =  A  (x  , ) , 

G  =  G  (x  , )  and  F  =  F  (x  , ,  x  ^)  are  not  constant,  but 
r    r  — rl       r    r  — rl   — r2 

nonlinear  functions  of  the  state  vector  x  .   In  this  study, 
unlike  previous  practices,  the  reference  model  is 
represented  by  a  nonlinear,  coupled  system,  i.e.,  ideal 
manipulator  dynamics.   All  works  known  to  the  best 
knowledge  of  the  author  typically  choose  a  linear,  decoupled, 
time-invariant  system  for  the  reference  model  and  force  the 
nonlinear  system  (manipulator)  to  behave  like  the  chosen 
linear  system. 


:•.»■•■* 


3.3   Design  of  Control  Laws  via  the 
Second  Method  of  Lyapunov 

3.3.1   Definitions  of  Stability  and  the 
Second  Method  of  Lyapunov 

In  this  section  various  definitions  of  stability 
are  reviewed.   Also,  Lyapunov 's  main  theorem  concerning 
the  stability  of  dynamic  systems  is  given.   For  a  detailed 
treatment,  the  reader  is  especially  referred  to  the  Kalman 
and  Bertram's  work  on  the  subject  [23]. 

Let  the  dynamics  of  a  free  system  be  described  by 
the  vector  differential  equation 
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X  =  f  (x,  t)  ,   -co  <  t  <  +«>  (3.21) 

where  x  e  R   is  the  state  vector  of  the  system.   Also  let         '-'/' 
the  vector  function  ^(t;  Xq,  t„)  be  a  unique  solution  of  V. 

Equation  (3.21)  which  is  dif f erentiable  with  respect  to 
time  t  such  that  it  satisfies 

(i)   i(tQ;  Xq,  t^)  =  Xq  (3.22)      , 

d^ 

(ii)        ^     (t;     Xq,     tg)     =    f(^(t;     Xq,     tg),     t)         (3.23)  ^. 

for  a  fixed  initial  state  Xq  and  time  t^. 

A  state  X   is  called  an  equilibrium  state  of  the 
free  dynamic  system  in  Equation  (3.21)  if  it  satisfies 

f (x  ,  t)  =  0,  for  all  t  (3.24) 

Precise  definition  of  stability  is  first  given  by 
Lyapunov  which  is  later  known  as  the  stability  in  the  sense 
of  Lyapunov. 

Definition  3.2:   An  equilibrium  state  x   of 
the  dynamic  system  in  Equation  (3.21)  is 
stable  (in  the  sense  of  Lyapunov)  if  for 
every  real  number  e  >  0  there  exists  a  real 
number  6(e,  tQ)  >  0  such  that  il  Xq  -  x^  |1  <  5 
implies  ^ 

i 

!U(t;  Xq,  tg)  -  x^  i  <  e  for  all  t  <  tg 

I 
The  norm  11  •  11  recresents  the  Euclidean  norm. 
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In  practical  applications,  the  definition  of 
stability  in  the  sense  of  Lyapunov  does  not  provide  a 
sufficient  criterion,  since  it  is  a  local  concept  and  the 
magnitude  6  is  not  known  a  priori.   Stronger  definitions  of 
stability,  namely  asymptotic  stability,  asymptotic 
stability  in  the  large,  and  global  asymptotic  stability, 
which  are  essentially  based  on  the  definition  of  stability 
in  the  sense  of  Lyapunov  with  the  additional  requirements, 
are  given  below.   The  definition  of  asymptotic  stability 
is  also  due  to  Lyapunov. 

Definition  3.3:   An  equilibrium  state  x  of 
the  dynamic  system  in  Equation  (3.21)  is 
asymptotically  stable  if 

(i)   It  is  stable  (Definition  3.2) 

(ii)   Every  solution  ^(t;  x „ ,  t^) 

starting  sufficiently  close  to  x 
converges  to  x  as  t  — *■  oo,      in 
other  words,  there  exists  a  real 
number  y(tQ)  >  0  such  that 
!l  ^0  "  ^  "  ^  ^^^0^  implies 

lim  II  ^(t;  Xq,  tp)  -  x^  i  =  0 

t— ♦■oo 

Definition  3.4:   An  equilibrium  state  x   of  the 
dynamic  system  in  Equation  (3.21)  is 
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asymptotically  stable  in  the  large  if 
for  all  x„  restricted  to  a  certain  region 
r  £  R 

(i)   X   is  stable 


(ii)    lim  |U(t;  Xq,  tg)  -  x^ll  =  0 

t  — »-oo 


Definition  3.5:   An  equilibrium  state  x  of 
the  dynamic  system  in  Equation  (3.21)  is 
globally  asymptotically  stable  if  the 
region  r  in  Definition  3.4  represents  the 
whole  space  R  ,  i.e.,  r  =  R  . 
Lyapunov's  main  theorem  which  provides  sufficient 
conditions  for  the  global  asymptotic  stability  of  dynamic 
systems  and  the  two  corollaries  are  given  below  [23] . 

Theorem  3.1:   Consider  the  free  dynamic  system 

X  =  f (x,  t) 

where  f (0,  t)  =  0  for  all  t.   If  there 
exists  a  real  scalar  function  V(x,  t) 
with  continuous  first  partial  derivatives 
with  respect  to  x  and  t  such  that 

(i)   V(0,  t)  =  0  for  all  t 

(ii)   V(x,  t)  >  a(!ix||)  >  0  for  all 
X  7^  0 ,  X  e  R  where  a(*)  is  a 
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real,  continuous,  nondecreasing 
scalar  function  such  that 
a(0)  =  0 

(iii)   V(x,  t)  — ►  «>  as  Ixl— »"»  for  all  t 


(IV)   V  =  ^  (X,  t)  =  g^ 


+  (grad  V)*^  f  (x,  t) 

<  -y(||x||)  <  0 

'  where  y(*)  is  a  real,  continuous 

scalar  function  such  that  y (0)    =    0 

'- :  then  the  equilibrium  state  x   =  0^  is  globally 

4,  asymptotically  stable  and  V(x,  t)  is  a 

Lyapunov  function  for  this  system. 

Corollary  3.1:    The  equilibrium  state 

X  =  0  of  the  autonomous  dynamic  system 
— e   —  -^ 

X  =  f  (x) 

is  globally  asymptotically  stable  if  there 
exists  a  real  scalar  function  V(x)  with 
continuous  first  partial  derivatives  with 
respect  to  x  such  that 

(i)   V(0)  -  0 

(ii)   V(x)  >  0  for  all  x  j^   0 ,    x   e    R^ 


■  ■.^ 
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(iii)   V(x)  — *-«=  as  ||  x 


(iv)   V  =  ^  (x)  <  0  for  all  x  ji   0_, 


X  e  R" 


Corollary  3.2:   In  Corollary  3.1,  condition  (iv) 
may  be  replaced  by 


(iv-a)   V(x)  <  0  for  all  x   7^    0 ,    x   e    R^ 


(iv-b)   V(^(t;  Xq,  tp))  does  not  vanish 
identically  in  t  >  tg  for  any 
tQ  and  Xq  7^  0^. 

Finally,  Lyapunov ' s  following  theorem  gives  the 
necessary  and  sufficient  conditions  for  the  (global) 
asymptotic  stability  of  linear,  time-invariant,  free  dynamic 
systems. 

Theorem  3.2;   The  equilibrium  state  x^  of  a 

linear,  time-invariant,  free  dynamic  system 

X  -  Ax  (3.25) 

is  (globally)  asymptotically  stable  if  and 
only  if  given  any  symmetric,  positive 
definite  matrix  Q,  there  exists  a  symmetric. 


,.  . .  ,^^ 
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positive  definite  matrix  P  which  is  the 
unique  solution  of  the  matrix  equation 

A^P   +  PA  =  -Q  (3.26) 

T 
and  V  =  X  Px  is  a  Lyapunov  function  for 

the  system  in  Equation  (3.25). 

3.3.2   Adaptive  Control  Laws 

Plant  and  the  reference  model  equations  are  given 
by  Equations  (3.1)  and  (3.12),  respectively.   Reference 
system  control  u  (t)  represents  the  open-loop  control  law. 
This,  for  example,  may  be  an  optimal  control  law  obtained 
off-line  through  minimization  of  a  performance  index. 

Due  to  the  error  in  the  initial  state,  disturbances       '^ 
acting  on  the  system  and  the  inaccuracies  in  the 
mathematical  model  such  as  frictional  effects,  structural 
deflection,  and  backlash,  open-loop  control  law  u^  =  u^(t) 
does  not  prove  effective  as  the  demand  on  precise  and  fast 
motion  increases.   Even  today's  servo-controlled  industrial 
manipulators  which  totally  neglect  the  dynamic  coupling 
use  closed-loop  control  laws. 

Now,  the  aim  is  to  find  the  structure  of  the 
controller  u  =  u  (x  (t) ,  x  (t) ,  u^(t))  such  that  the 
desired  trajectory  is  tracked.   Defining  the  error  e(t) 
between  the  reference  and  the  plant  states 


'j-i 


■^ 


..^A 
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e  =  e(t)  =  X  (t)  -  X  (t)  e  R^^  (3.27) 


,  T    T>T    ,  T      T     T      T  .  T     /^  ^o^ 
e  =  (e^,  £2)   =  (x^^  -  Xp^,  x^2  "  ^2^      ^2.28) 


e   e  r",  e„  e  R^  (3.29) 

-1       -2 


de(t) 


and  choosing 


u  =  u*  +  u"  (3.31) 

-P   -P   -P 


u'=A(A"'"G   x,+A    F   X--K,  e,  -  K^e„  ) 
— p    P   r    r  — rl    r    r  — r2     1—1     2—2 


(3.32: 


where 


u"  is  part  of  the  controller  yet  to  be  designed 

K,  ,  Kp  £  j^nxn  ^^^  constant  matrices  to 
be  selected 

error-driven  system  equations  can  be  obtained  by  substituting 
Equations  (3.31)  and  (3.32)  into  Equation  (3.1),  subtracting 
the  resulting  equation  from  Equation  (3.12)  and  substituting 
Equations  (3.27-3.30)  as  follows: 


e  =  Ae  +  Bz  -  BA"-""  u"  (3.33) 

-    -    -     P   -P 


where 


TfM  T 
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A  = 


^1     ^2 


ro 


,  B  = 


(3.34) 


A  £  R^^^^n^  3  ^  ^2nxn 


I  and  0  are  nxn  identity  and  null  matrices, 
respectively 


z  =  -a"-*-  G   X  ,  -  a"-"-  F   X  ^  +  a"-"-  u        (3.35) 
P   P  ^1    P   P  -P2    r   -r 


z  £  r",  u"   £  r" 
-p. 


It  should  be  noted  that  the  part  of  the  controller 

u'  requires  only  the  on-line  calculation  of  the  plant 

generalized  inertia  matrix  A  =^  A  (x  )  ;  other  nonlinear 
^  P    P  -P 

terms  A   =  A   (x  , ) ,  G   =  G  (x  , )  and  F   =  F  (x  )  are 
r     r  — rl    r    r  — rl       r    r  — r 

reference  model  parameters  and  known  a  priori  for  each  given 

task,  i.e.,  A   ,  G  ,  and  F  will  not  be  calculated  on-line. 

Various  controller  structures  can  be  chosen  for  u" 

-P 

using  the  second  method  of  Lyapunov  (Theorem  3.1,  Corollary 
3.1) .   This  method  is  especially  powerful,  because  it 
assures  the  global  asymptotic  stability  of  the  error-driven 
system,  hence  the  manipulator,  without  explicit  knowledge 
of  the  solutions  of  the  system  differential  equations.   Let 


.;"* 
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V(e)  =  e'^Pe  (3.36) 


define  a  real,  scalar  positive  definite  function.   Using 
Equations  (3.33)  and  (3.36), 


where 


V(e)  =  -e'^Qe  +  2v'^z  -  2v'^  a""""  u"  (3.37) 


Q  £  ^^^^^^   positive  definite  matrix  (Q  >  0)  , 


P  £  R  "^  "  solution  of  the  Lyapunov  equation 


^P  +  PA  =  -Q  (3.38) 


and 


"^  P  e  (3.39) 


V  =  B   P  e 

A  discussion  on  the  uniqueness  of  the  solution  P  of  the 
Lyapunov  equation  is  given  in  the  following  section. 

Now,  if  V(e)  <  0  is  satisfied,  global  asymptotic 
stability  of  the  error-driven  system  will  then  be  guaranteed 
according  to  Corollary  3.1.   This  condition  can  actually  be 
replaced  by  V(e)  <  0  in  the  sense  of  Corollary  3.2.   Also, 
V(e)  will  be  a  Lyapunov  function  for  the  system  in  Equation 
(3.33).   Different  controller  structures  are  explored  below. 


'■i 

.■-;.Ji 
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3.3.2.1   Controller  structure  1 


If  u"  were  chosen 
-P 


or 


u"  =  A  z  (3.40: 

-P     P- 


u;  =  -Sp  -  fp  +  Ap(A;l  u^)  (3.41) 


where 


g   =G  x,,f   =F  X- 
-P    P  -Pl   -P    P  -P2 


(3.42) 


then  condition  (iv)  of  Corollary  3.1,  V  <  0,  would  be 

satisfied.   In  fact,  these  choices  in  Equations  (3.40)  and 

(3.41)  correspond  to  the  cancellation  of  nonlinearities  and 

can  be  viewed  as  the  nonlinearity  compensation  method  widely 

used  in  the  literature  (Chapter  1) .   However,  since  this 

form  of  u"  assumes  exact  cancellation  of  terms  a  priori, 
— p 

Lyapunov's  second  method  does  not  guarantee  global 
asymptotic  stability,  if  cancellations  are  not  exactly 
realized. 

3.3.2.2   Controller  structure  2 

Another  choice  for  u"  will  be 

-P 

u"  =  A   diag[sgn  (v.)]  {b  +  Sk}  (3.43) 

— p     p     ^  <■    ^  1     _    _ 


where  diag[sgn  (v.)]  is  an  nxn  diagonal  matrix  with 
diagonal  elements  sgn  (v.),  i  =  1,2, ...,n. 


■<y 


'?-^.> 
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b    =  sup  {  I  -A         q       +    A         U     I  } 

~0<x.<2tt  P      -^ 

P/i 

u      .    e   U 
r,i 

i   =   1, .. . ,n  (3.44) 


U  is  a  subset  of  the  set  of  all  possible  inputs,  within  which 
open-loop  control  law  u  (t)  is  contained,  i.e.,  ^^^  ^  ^  U, 
i  =  l,2,...,n.   The  generalized  inertia  matrix  A  (x  , )  is 
nonsingular  [54] ,  also  elements  of  A   ,  A   ,  and  g  are  all 
bounded,  i.e. ,  if 


^'  (^pi)  =  f^ij^^pi)^  ^'-''^ 


then 


(-ij^^-ij(^pl)  ^  ^-ij^u  ^'-''^ 


where  (a. . ) ,  and  (a. .)   are  the  lower  and  upper  bounds  on 
a..(x  ,),  0  <  X  ,  ,  <  2tt;  i,j,k  =  1,2,. ..,n.   Similarly, 

13  — P-L  P-L/K 

bounds  on  the  gravity  loads  g   can  be  given.   A   u^  = 
A~  (x   (t))u  (t)   in  Equation  (3.44)  is  known  for  a  given 
manipulation  task,  since  it  represents  the  reference. 
Referring  to  Equation  (3.43), 


S   =    [s.  .]    e    r"""""  (3.47) 

is   defined   by  ' '^  v 

■■■■•A 


i 
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A 


s..  =       sup      {|a..|};  i,j  =  l,2,...,n 

^^    0  <x  ,   ,  <27T  ^^ 

v  —  r  '^  V*                   "^  V*               "^  v*            1 

-  ~  ^-p2  ^1  -p2   -p2  ^2  -p2    •••    -p2  ^n  -p2J 

k  e  r"  (3.49) 

where  constant  positive  definite  K.  e  R     ig  to  be  chosen 
so  that 


x"^-  K*  X    >   x^^    D.  X  T  (3.50) 

-P2   1  -p2    -P2   1  -p2 


and 


^  „  K*  X  „  >  0  for  all  X  ^  7^  0  (3.51) 

p2   1  — p2  — p2    — 


where  D.,  i  =  l,...,n  is  as  defined  by  Equations  (2.70)  and 
(2.75);  D.  in  Equation  (3.50)  can  be  replaced  by  symmetric 

d:  =  ^  (D.  +  D*^)  (3.52) 

1    2    1     1 

T  T 

so  that  x-,DIx^  =  XtD.  x^is  preserved.   Existence 
— p2   1  — p2    — p2   1  — p2     '^ 

of  positive  definite  K*  is  shown  using  the  following  theorem 

[6]. 

Theorem  3.3;   Let  M  be  a  symmetric,  real  matrix 

and  let  A  .  (M)  and  X         (M)  be  the  smallest 
mm         max 


and  the  largest  eigenvalues  of  M, 
respectively.   Then 
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X  (M)    II  X  f    <   x^   MX   <    X  (M)||  X  f 

min  —  '  —        —  nisx  —  ■ 


?  n         „ 

for   any   x   e    R    ,    where  ||  x  ||     =      \      x.  , 

i=l   ^ 


(3.53) 


Using  Theorem  3.3, 


X    .     (K*)    II  x   o  iP   <  x'^„   K*   X    o   ^   ^         (K*)    ix   - 
mm      1      "  — p2  "  — p2      i  — p2  max      i      "  — p2 


(3.54) 


.     (DI)    ||x    -  f    <   x'^„    d:    X    ^    <    X         (D!)    Ilx    -P 
mxn      1     " -p2  "  -p2      i   -p2  max      i      '' -p2  " 


(3.55) 


Here  K*  is  assumed  to  be  ^a  real,  symmetric  matrix.   If  K* 
is  not  symmetric,  then 


.*•  _  1  ,.,*  ,  .,*T, 


kV  =  J  (kJ  +  K?")  (3.56) 


must  be  replaced  by  K.  in  Equation  (3.54).   Also,  all 

entries  of  d!  =  dI  (x  , )  are  bounded  and,  in  general,  d!  is 
1    1  —pi  '  ^  '   1 

T 
indefinite.   Quadratic  surfaces  x  -  Dl  x  -/  its  lower  and 

upper  bounds  (x^2  °i  ^p2^£  ^"^  ^^2  °i  ^p2^u'  ^"^  ^2  ^i  ^p2 
are  conceptually  represented  in  Figure  3.5. 

If  X  .   (K*)  is  chosen  such  that 
mm    1 


X  .   (K*)  >    X     (D!)  (3.57) 

mm    1     max    i 


'■'■ :  ,11 
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T 
— p2  1— p2 


(x  tD!x  -,) 
— p2  1— p2 


Figure  3.5   Representation  of  Quadratic  Surfaces 


is  satisfied,  where 


X  (D!)  =       sup       {^-;(D!(x  ,  )) 

"»^^     ^       0  <  X  /  .   <  2TT    ^    ^  -Pl 

pi /I 

i  =  1 ,  .  •  .  ,  n 


j  =  1,2, ...,n} 


(3.58) 
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then 

x'^o  K*  X  ^  >  x'^^  d:  X  „  (3.59) 

— p2   1  — p2    -p2   1  — p2 

follows  directly  from  Equations  (3,54)  and  (3.55).   In 

addition,  if  X  .   (K*)  >  0,  then  x"^^-  K*  x  _  >  0  for  all 
min    1  —  p^      1  ~P'^ 

X  ^  7^  0.   That  is,  symmetric  K*  e  R     is  positive  definite, 
— p2  1 

if  and  only  if  all  the  eigenvalues  of  K*  are  positive  [36]. 

One  choice  for  K*  which  satisfies  Equation  (3.50) 
is 


K*  =  diag[X    (D.')]  (3.60) 

1      ^   max   1 


where  K* ,    in  this  example,  is  a  diagonal  matrix. 

This  control  described  by  Equations  (3 . 43) - (3 . 44) , 
(3.47)- (3.49)  will  satisfy  Corollary  3.1  and  assure  the 
global  asymptotic  stability  of  the  manipulator.   It  should 
be  noted  that  b,  S,  and  K.,  i  =  l,...,n  are  all  constant 
matrices,  hence  its  implementation  is  not  computationally 
demanding.   However,  its  disadvantage  is  that  the 
discontinuous  signal  due  to  sgn  function  will  cause 
chattering. 

3.3.2.3   Controller  structure  3 

The  chattering  problem  in  the  above  controller  will 

be  alleviated  if  u"  has  the  form 

-P 

u"  =  A   Q*  v  (3.61) 

-P     P     - 
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where  Q*    e    R  constant,  positive  definite  matrix.   In 

this  case,  due  to  the  term  in  V  linear  in  v(t)  ,  i.e.,  2v'^z, 
solution  can  only  be  guaranteed  to  enter  a  spherical 
region  containing  the  origin  in  the  error  space  [23] . 
Absolute  minimum  of  V  which  is  not  the  origin  anymore  will 
lie  in  this  region.   In  fact,  part  of  the  V  expression, 
V'  =  V' (v) 

V'  =  -2v^   Q*  V  +  2v'^z  (3.62) 

will  have  absolute  minimum  at 


V  =  I  (Q*)"^  z  (3.63) 


In  general,  this  spherical  region  can  be  reduced  as 
the  magnitude  of  u"  is  increased,  which  actually  translates 
into  the  use  of  large  actuators.   This  can  easily  be  shown 
observing  Equation  (3.63).   Assimiing  that  Q   is  the  diagonal, 
absolute  minimum  will  approach  to  zero  as  the  magnitudes  of 
the  diagonal  elements  are  increased. 

Although  this  controller  eliminates  the  chattering 
problem  and  is  the  easiest  for  implementation,  it  cannot 
completely  eliminate  the  error  in  the  state  vector.   This 
error  will  be  reduced  at  the  expense  of  installing  larger 
actuators . 

3.3.2.4   Controller  structure  4 

This  controller  has  the  structure 


ur  =  (-Kp  +  AKp)  Xp  +  (K^  +  AK^)  u^         (3.64) 


<I^yM 
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where 


Kp  =  [Gp  :  Fp]  (3.65) 


AK   =  [R^  V  (S^  ^pl^^  •  ^2  -  ^^2  -p2^'^^     (3.66) 


K   =  [A  a"-^]  (3.67) 

u    '  p  r  ^ 


AK^  =  [R3  V  (S3  u^)'^]  (3.68) 

K  and  AK   e  f^nx2n 
P       P 


K  and  AK   e  r"^" 
u       u 


G  ,  F  ,  and  A  denote  the  calculated  values 
P   P       P 

of  G  ,  F  ,  and  A  given  by  Equations 
p   p       p  ^      -in. 


(3.6)-(3.7) ,  (3.10) ,  and  (2.44) , 
respectively 


R.  e  R^^^,    R.  >  0,  and  (3.69) 

1       '1 


S.  £  R"^",  S^  >  0,  i  =  1,2,3;  are  (3.70) 

to  be  selected 

v  is  as  defined  by  Equation  (3.39) 


Let 


'■if::  : 
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V(e,  t)    =   e^P   e   +   2    \       (v'^a'-'-R^  v)  (x"^,  S^x  ,  )  dt 
-  p   1—  —pi  1— pi 


rt 


+  2 


T  — 1        T   T 

(V  A^  R^v)  (x^„S::x^-)dT 
Q   -  p   2-  -p2  2-p2 


+  2 


ft 


0 


(v'^Ap-'-R^v)  (u^S3U^)dT   (3.71) 


define  a  Lyapunov  function.   Differentiating  Equation  (3.71) 
with  respect  to  time  and  substituting  Equations  (3.33), 
(3  .  64) -  (3 . 68) ,  and  (3.38)  into  the  resulting  expression, 
V(e)  will  be 


V(e)  =  -e"^  Q  e  +  2v'^  z' 


;3.72) 


where  P  is  the  solution  of  the  Lyapunov  equation 


A  P  +  PA  =  -Q,  Q  >  0 


(3.73) 


and 


z'  =  a"-"-  [  (g   -  g  )  +  (f   -  f  )] 

—        p      'ip     2.p'  ^_p     _p' 


+  (a""*"  -  a  ■'"  a   a  "'")  u 
r      p    p   r    — r 


(3.74) 


An  estimation  of  the  bound  of  ||  e  ||  is  given  below. 

If  V(e)  is  negative  outside  a  closed  region  r  subset 
of  R    including  the  origin  of  the  error  space,  then  all 


'^ 
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solutions  of  Equation  (3.33)  will  enter  in  this  region  r 
[23].   Substituting  Equation  (3.39)  into  Equation  (3.72) 


V(e)  =  -e"^  Q  e  +  26"^  PB  z' 


(3.75) 


where 


^^^^  ^  -  ^min^Q^  1'^"   ""  ^ll^'l  II  ^11  1'^^'  II      ^^-^^^ 


X  .  (Q)  is  the  smallest  eigenvalue  of  Q 
mm 


denotes  the  Euclidean  norm 


ii2    T 
e   =  e  e 


(3.77) 


P   =  X    (P) ;  the  largest  eigenvalue 
"   "    max  ^      ^ 


of  P,  since  P  is  positive  definite 
and  symmetric  [23] 


z-  II  =  [(z-)'^  z']-^'^^ 


(3.78 


Also,  recalling  Equation  (3.34), 


Bz'  = 


z-  =  [O"^,  (z')^]^ 


(3.79) 


where 


0  denotes  then  x  n  null  matrix,  and 


0  e  r"  represents  the  null  vector. 


Ibz-  i  =  II  z-  II  (3.80) 

follows  from  Equation  (3.79).   Now,  from  Equation  (3.76), 
V(e)  <  0  is  satisfied  for  all  e  satisfying 


2  I  P    z 


all  >  -^ =-  (3.81) 

Vin(Q) 


Hence,  an  upper  bound  on  the  error,  ||  e  ||  will  be 

2  1^ « I  i'L 


lax 


-"max  <   X^.^(Q) 


(3.82) 


It  is  clear  from  Equation  (3.82)  that  this  bound  on 
||e||  will  be  reduced  as  ||p||  is  decreased,  ^jj,j_n^^^  increased 

or  II  z'l     — s-0.   It  should  also  be  noted  that  frequent 

"  —  "  max 

updating  of  g  ,  f„,  and  i  will  affect  |  z'||     — *-  0,  hence 

— p   — ^p  p  luctx 

lie II     — >-  0.   At  steady  state,  e  =  0,  control  will  take 

"  — ''  max  -^        —   — 

the  form 


u-  (t)  =  u^(t)  (3.83) 

-^  — r 


and 


z'  -  a"-"-  u"  =  0 
P  -p   - 


>:■-■ 
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or 

z'  =  0  (3.84) 

hence  Equation  (3.33)  would  yield 

e  =  A  e 

Controllers  presented  in  this  section  have  the 
general  form 


u  =  u'  +  u"  (3.85) 

-P   -P   -P 


Analysis  is  given  assuming  that  the  calculated  A  ,  i.e., 

A  ,  is  exact  only  in  the  u'  part  so  that  A    A   =  I  is 
p  ^         -P  ^  P    P 

satisfied.   This  assumption  is  made  to  facilitate  the 
analysis.   Computer  simulations  presented  later  in  Chapter  6 
did  not,  however,  use  this  assumption.   In  the  second  part 
of  the  controller,  i.e.,  u" ,  calculated  terms  g  /  f.  /  and 

IT  £r  ir 

A  ,  i.e.,  q  ,  f  ,  and  A  ,  are  explicitly  shown  in  the 

p'       — P  — P       P 

analysis  (Controller  structure  4) .   Current  arguments  with 

reference  to  Equations  (3.82)  and  (3.74)  suggest  that  g 

and  f  may  be  updated  at  a  slower  rate  compared  to  the  A  . 

This  result  is  important,  since  especially  the  calculation 

of  f  ,  in  general,  requires  more  computation  time  compared 

to  A  .   Although  it  is  clear,  the  above  controllers  need  the 

on-line  measurements  of  plant  joint  displacements  x  ,  and 

the  velocities  x  ^. 
-p2 
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3.3.3   Uniqueness  of  the  Solution 
of  the  Lyapunov  Equation 

The  Lyapunov  equation  is  given  by  Equation  (3.38). 

2nx2n  . 


The  uniqueness  of  its  solution  P  e  R 
,2nx2n 


is  guaranteed,  if 
A  e  j^— ^-"  j^^g  eigenvalues  with  negative  real  parts  as 
given  by  the  following  corollary  [6] . 

Corollary  3.3;   If  all  the  eigenvalues  of  A 
have  negative  real  parts,  then  for  any  Q 
there  exists  a  unique  P  that  satisfies  the 
matrix  equation 


A  P  +  PA  =  -Q 

T,     J  ^    „2nx2n 
where  A,  P,  and  Q  e  R 

Recalling  Equation  (3,34),  A  is  given  by 


A  = 


^1    ^2 


r^,    ,     ^       ■    ^-  J.-  ^    n         „2nx2n  . 

The  characteristic  equation  of  A  e  K      is 


n 


det  [si  -  A]  =  s   det 


si  -  K2  - 


s   1 


(3.86) 


where 


I  represents  a  2n  x  2n  identity  matrix  on 
the  left-hand  side  of  Equation  (3.86); 


otherwise  it  is  understood  that  I  e  R 


nxn 


■m 
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s  is  the  complex  variable. 


K,  and  K2  e  R 


nxn 


If  K,  and  K-  are  diagonal  matrices 


K^  =  diag  [K^.^],  K^   =   diag  [K2.j_] 


(3.87) 


where 


K, _ .  and  K~,.  are  the  respective  diagonal 
(1,1)''-'^  entries  of  K,  and  K- ,  i  =  1,2, 


,n 


then 


n 
det  [si  -  A]  =   n   (s' 
i=l 


-  K-  .s  -  Kt  . )      (3.88) 
2  ;  1      1 ;  1 ' 


that  is,  the  time-invariant  part  of  the  error-driven  system 
(not  the  manipulator  dynamics)  will  be  decoupled.   Hence, 
referring  to  Equation  (3.88),  all  the  eigenvalues  of  A  will 
have  negative  real  parts  if  K,  .  <  0  and  K    <  0. 
Corollary  3.3,  then,  assures  the  existence  and  uniqueness  ■-. 
of  the  solution  of  Lyapunov  equation. 


3.4   Connection  with  the  Hyperstability  Theory 
In  this  section,  basic  definitions  and  results  on 
hyperstability  are  reviewed  and  it  is  pointed  out  that  the 
globally  asymptotically  stable  closed-loop  systems  designed 


';-r^A', 
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in  the  previous  section  (Section  3.3.2)  are  also 
asymptotically  hyperstable.   It  is  noted  that  here  only  the 
necessary  results  are  covered  and  some  definitions  are 
inserted  for  clarity.   Detailed  treatment  of  the  subject 
can  be  found  in  [29,  42] . 

The  concept  of  hyperstability  is  first  introduced 
by  Popov  in  1962  [42]  .   The  following  definitions  of 
hyperstability  and  asymptotic  hyperstability  are  also  due 
to  Popov  [29] . 

Definition  3.6;   The  closed-loop 
system 

X  =  Ax  -  Bw  (3.89) 

V  =  Cx  (3.90) 

w  =  f (v,  t)  (3.91) 


where 


(i)   xeR^n^  ^^^n^  ^  ^  ^n^  ^  ^  j^2nx2n^ 

A,  B,  and  C  are  time-invariant, 
f(')  eR   is  a  vector  functional 
(ii)   The  pair  (A,B)  is  completely 
controllable 
(iii)   The  pair  (C,A)  is  completely 
observable 


.!| 


f.- 
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is  hyperstable  if  there  exists  a  positive 
constant  5  >  0  and  a  positive  constant 
Yq  >  0  such  that  all  the  solutions 
x(t)  =  ^  (t;  Xq,  tg)  of  Equations  (3.89)- 
(3.91)  satisfy  the  inequality 


x(t)  II  <  5(||x(0)l  +  Yq)  for  all  t  >  0 


(3.92) 


for  any  feedback  w  =  f (v,  t)  satisfying  the 
Popov  integral  inequality 


n(tQ,  t^)  = 


IT  2 

V  w  dt  >   -Yn        (3.93) 

t 


for  all  t,  ^  t-j. 
Definition  3.7:   The  closed-loop  system  of 

Equations  (3 . 89) - (3 . 91)  is  asymptotically 
hyperstable  if 

(i)   It  is  hyperstable 

(ii)    lim  x(t)  =  0  for  all  vector 

t  — ».oo  ~      - 

functionals  f (v,  t)  satisfying  the 
Popov  integral  inequality  of 
Equation  (3.93)  . 
Popov's  main  theorem  concerning  the  asymptotic  hyperstability 
of  the  system  described  in  Equations  (3 . 89) -  (3 . 91)  and  (3.93) 
is  given  below  [29] . 
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Theorem  3.4;   The  necessary  and  sufficient 

condition  for  the  system  given  by  Equations 
(3.89)-(3.91)  and  (3.93)  to  be 
asymptotically  hyperstable  is  as  follows: 
The  transfer  matrix 


H(s)  =  C(sl  -  A)"-"-  B  (3.94) 


must  be  a  strictly  positive  real  transfer 
matrix. 
The  strictly  positive  real  transfer  matrix  is  defined  below. 
Definition  3.8;   An  m  x  m  matrix  H(s)  of  real 

rational  functions  is  strictly  positive  real 
if 

(i)   All  elements  of  H(s)  are  analytic 
in  the  closed  right  half  plane 
Re(s)  >   0  (i.e.,  they  do  not  have 

poles  in  Re(s)  >  0) 

T 
(ii)   The  matrix  H(joj)  +  H  (-jto)  is  a 

positive  definite  Hermitian  for 

all  real  co . 

The  following  definition  gives  the  definition  of  the 

Hermitian  matrix. 

Definition  3.9;   A  matrix  function  H(s)  of  the 

complex  variable    s=a+jwisa   Hermitian 

matrix  (or  Hermitian)  if 
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H(s)  =  H^(s*)  (3.95) 


where  the  asterisk  denotes  conjugate. 
Finally,  the  following  lemma  [29]  gives  a  sufficient 
condition  for  H(s)  to  be  strictly  positive  real. 

Lemma  3.1:   The  transfer  matrix  given  hy 

Equation  (3.94)  is  strictly  positive  real 
if  there  exists  a  symmetric  positive 
definite  matrix  P  and  a  symmetric  positive 
definite  matrix  Q  such  that  the  system  of 
equations 

A^P   +  PA  =  -Q  (3.96) 


C  =  B^P  (3.97) 


can  be  verified. 
Recalling  the  error-driven  system  equations,  Equation 
(3.33),  closed-loop  system  equations  are  given  by 

e  =  Ae  +  Bz"  (3  .98) 

where 

z"  =  £  -  A~^  u"  (3.99) 

P     ir 

z_   is  defined  by  Equation  (3.35),  A  and  B  are  as  given  by 

Equation  (3.34).   Various  controller  structures  for  u"  are 

-P 


■n 


E  „:   ..-.si 


'  '  »<'' 
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<      1^: 


given  in  Section  3.3.2  assuring  the  global  asymptotic 
stability  of  the  closed-loop  system  of  Equation  (3.98). 
Referring  to  Definition  3.6  and  Equation  (3.98) 

w  =  -z"  (3.100) 

The  second  method  of  Lyapunov  essentially  required 

T 
that  for  a  positive  definite  function  V(e)  =  e  Pe 

V(e)  <  -£"^06  +  2v'^z"  (3.101) 

is  satisfied.   Note  that  Equations  (3  .  38) -  (3  .  39)  and  (3.98) 

are  used  in  obtaining  Equation  (3.101).   If  Q  is  positive 

T 
definite,  then  -Q  is  negative  definite,  i.e.,  -e  Qe  <  0  for 

all  e  7^  0 .   Hence,  to  satisfy  corollary  3.1, 


v'^z"  <  0  (3.102) 


is  sufficient  for  the  global  asymptotic  stability  of  the 
system  in  Equation  (3.98). 

On  the  other  hand.  Theorem  3.4  requires  that  the 
transfer  matrix  given  by  Equation  (3.94)  be  strictly  positive 
real.   Lemma  3.1,  in  turn,  requires  that  positive  definite 

P  which  is  the  solution  of  the  Lyapunov  equation,  Equation 

T 
(3.96),  exists  and  C  =  B  P  is  satisfied.   Noting  that  Equation 

T 
(3.39)  defined  v  =  B  Pe,  both  conditions  are  already  required 

by  the  second  method  of  Lyapunov. 


k^ 
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However,  Theorem  3.4  assvimes  that  the  Popov  integral 
inequality  is  satisfied.  Substituting  Equation  (3.100)  into 
Equation  (3.93) 


-n(tQ,  t^)  = 


-^  v'^z"  dt  <  -Yq  (3.103) 

^0 


T 
must  hold.   But,  if  v  z^"  <  0  is  satisfied,  Equation  (3.103) 

will  also  hold.   Indeed,  Equation  (3.103)  represents  a  more 

relaxed  condition  compared  to  Equation  (3.102),  but  for  the 

system  in  Equation  (3.98)  and  z^"  which  is  an  implicit 

function  of  time,  direct  use  of  Popov's  condition  is  not 

immediate . 

The  definition  of  hyperstability  also  presumed  the 
complete  controllability  and  the  complete  observability  of 
the  pairs  (A,B)  and  (C,A),  respectively.  These  conditions 
are  checked  in  the  following  section. 

In  view  of  the  above  discussions,  the  closed-loop 
system  which  is  globally  asymptotically  stable  will  also  be 
asymptotically  hyperstable. 

3.5   Controllability  and  Observability 
of  the  (A,B)  and  (C,A)  Pairs 

Definition  of  hyperstability  in  the  above  section 

assumed  that  the  pair  (A,B)  is  completely  controllable  and 

(C,A)  is  completely  observable;  A  and  B  are  defined  in 

Equation  (3.34).   First,  for  the  pair  (A,B) 
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[B  AB  A  B 


A^^-^B]  = 


I    K, 


e  R 


2nx2n' 


(3.104) 

must  have  rank  2n  for  the  complete  controllability  of  the 
pair  (A,  B) .   The  controllability  matrix.  Equation  (3.104), 
will  have  full  rank  2n,  since  its  first  2n  columns  will 
always  span  R   "  regardless  of  the  choice  of  matrix 


K2  e  R 


nxn 


Hence,  the  pair  (A,  B)  is  completely 


controllable , 


Let  P  e  R  "^  ",  which  is  the  solution  of  the  Lyapunov 


equation,  be  given  by 


P  = 


1 


(3.105) 


,nxn 


where  P-,  ,  P-j,  and  P^  e  R    and  P,  and  P,  are  symmetric, 
Then,  C  e   R^^^n  ^^^^   ^^^^   ^^^    ^^^^ 


C  =  b'^P  =  [P2   P3] 


(3.106) 


For  the  complete  observability  of  the  pair  (C,  A) 


[C^  aV  (A^)2c^ 


(A^)2^-^  C^]  e    R^^^^n' 


(3.107) 


^  .jj,^ 


.  ,■-  ^.^ 


must   have   rank   2n.      Hence, 
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[c"^  A^C^    (A^)  ^C^    ...]    = 


T 
K^P3 


T  T    T 

K^P2+K3_K2P3 


P3      P2+K^P3      K^P2  +  (K^+K^)P3 


(3.108) 


is  supposed  to  have  rank  2n.   Since  P  given  by  Equation 
(3.105)  is  positive  definite,  hence  nonsingular,  first 
n-columns  of  the  observability  matrix  in  Equation  (3.108) 
will  be  linearly  independent.   Therefore,  a  rank  of  at  least 
n  is  assured.   Clearly,  the  rank  of  this  observability 
matrix  will  depend  on  Pp,  P..,  K,  ,  and  K- .   At  this  stage  it 
is  assumed  that  P-,  P^  of  matrix  P  and  the  selected  K,  and 
Kp  are  such  that  the  (C,  A)  pair  is  completely  observable. 

3.6   Disturbance  Rejection 
The  most  important  question  to  be  raised  of  a 
control  system  is  its  stability.   If  it  is  not  stable, 
neither  a  reasonable  performance  can  be  expected,  nor 
further  demands  may  be  satisfied.   As  should  be  clear  by 
now,  in  this  study,  system  stability  is  highly  stressed  and 
actually  complete  design  of  the  controllers  concentrated  on 
the  verification  of  stability  and  tracking  properties  of 
the  system. 
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Although  stability  of  a  control  system  is  necessary, 
it  is  not  sufficient  for  acceptable  system  performance. 
That  is,  a  stable  system  may  or  may  not  give  satisfactory 
response.   Further  demands  on  a  control  system  other  than 
the  stability  will  be  its  ability  to  track  a  desired 
response,  to  give  acceptable  transients  and  its  capability 
to  reject  disturbances.   Optimal  behavior  of  the  system  in 
some  sense  may  also  be  required. 

Since  global  asymptotic  stability  (also  the 
asymptotic  hyper stability)  of  the  system  is  assured  in  the 
error  space,  tracking  property  is  already  achieved  with 
the  proposed  controllers  of  Section  3.3.2.   Acceptable 
transient  response  will  be  obtained  by  the  choice  of  "  ^  "• 

matrices  K,,  K2,  Q,  S^,  R^,  i  =  1,2,3  as  given  before.  :,] 

The  main  drawback  of  the  designed  controllers  is 
the  implicit  assumption  that  the  reference  model  parameters 
are  exactly  the  same  as  that  of  the  actual  manipulator. 
These  parameters  include  manipulator  link  lengths,  link 
offsets,  twist  angles,  link  masses,  and  inertia  tensors. 
Although  close  estimations  of  these  constant  parameters  may 
be  assumed  known  a  priori,  information  on  their  exact 
values,  in  general,  will  not  be  available.   This  , 

discrepancy  will  deteriorate  the  system  response.   This  poor 
knowledge  of  plant  parameters,  other  plant  imperfections  ;  v 

which  are  not  represented  in  the  mathematical  model,  •  •"  ■ 
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inaccurate  measurement  devices,  measurement  delays,  and      v^. 
delay  in  the  control  due  to  the  time  required  for  its 
implementation  all  represent  disturbances  acting  on  the 
system.   If  the  controller  is  so  designed  that  under  these 
disturbances,  the  plant  can  still  reproduce  the  desired 
response,  then  the  system  is  said  to  have  the  disturbance 
rejection  feature. 

In  this  section,  only  an  attempt  is  made  to  reject 
disturbances  which  will  cause  steady  state  error  in  the 
system  response  through  the  introduction  of  integral 
feedback.   This  relatively  modest  effort,  however,  greatly 
improved  the  system  response  under  various  disturbances 
in  computer  simulations  as  discussed  in  Chapter  6.   These 
simulations  basically  included  the  discrepancy  in  the 
manipulator  parameters  between  the  reference  and  the  plant 
equations,  measurement  delays,  and  the  delay  in  control 
law  implementation. 

Let  the  new  state  vector  e   be  defined  by 

%  =  (£ar  i'  aL>^  '^•"^' 


where 


subscript  a  is  used  throughout  in  this  section 
to  denote  the  augmented  system. 
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r>3n  ,       „n 

e^  e  R   ,  e^, ,  e^„,  and  e  ^  e  R  , 
—a        — ai  — a^      — a-i 


^al  "  ^1  (3.110) 


e^2  =  £2  (3.111) 


e,  and  62  are  as  defined  in 


Equations  (3  .  27) -  (3 . 28) 
also  defining 


e^3  =  -I  e^^  (3.112) 


e  ^  is  given  by 


— a3 


le  , (t)  dt  (3.113) 

— al 


The  control  u   denotes  the  plant  input  and  has  the 
form 


u   =  u'   +  u"  (3.114)     T 

— ap    — ap    — ap 

where  u'   is  now  given  by  >;  '' 

— ap        ^2 

u'   =  A  (A~  G  X  ,  +  A~  F  X  -  -  K,e  , 

— ap    p   r   r— rl    r   r— r2     1— al  •  •; 

-    K2ia2  -  ^3^a3)        '  ^^'l^^)       .. 

and  -.%| 


-ap    -p 


(3.116) 


^ 


I 

It-  ■''^^''^ 

IS..-  'r.-tA 


1  •  '  ;jltV-,~,. 
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where  u"  is  as  given  for  various  controllers  in  Section 
-P 

3.3.2.   Substituting  Equations  (3  .  115) -  (3 . 116)  into 
Equation  (3.1)  and  subtracting  the  resulting  equation 
from  Equation  (3.12),  also  using  Equations  (3.110)-. 
(3.111)  along  with  Equation  (3.112),  the  augmented 
error-driven  system  equations  are  obtained  as  follows: 


e  =Ae   +Bz" 
—a    a— a    a— 


(3.117) 


where 


A  = 
a 


al    a2    a3 


-I 


'  ^a  = 


(3.118) 


n3nx3n   „     n3nxn 
A   e  R      ,  B   e  K     , 
a  a 


„    ^nxn    , ,    .  .    T    „nxn  .  ,   ...     .  . 
0  £  R    null  matrix,  I  e  R     identity  matrix. 


K  ,,  K  ~,  and  K  ,  e  R    are  to  be  selected, 
al    a2'       a3 


e   and  z"  are  as  given  by  Equations  (3.109) 
and  (3.99),  respectively 


Due  to  poor  estimation  of  manipulator  parameters 
in  the  reference  model,  closed-loop  system  signal  z^"  may  be 
considered  to  represent  the  disturbance.   Note  that  for  the 


^■■B 


-  •;•-!* 
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.?• 


controller  4  of  Section  3.3.2.4,  £"  is  given  by  the 
right-hand  side  of  Equation  (3.74).   At  steady  state  this 
signal  z"   will  be  assumed  constant,  represented  by  z" 


ss 


Note  that  in  general  z^"     7^  0^  due  to  parameter 
discrepancies . 

Now,  at  steady  state,  equilibrium  state  is 
determined  from 


e  „  =  0 
— a2   — 


al  — al    a2  — a2    a3  — aJ 


=  z' 


ss 


(3.119) 


-e  ,  =  0 
— al   — 


,nxn 


Assuming  that  the  selected  K  ,  e  R     is  nonsingular,  the 
equilibrium  state  is  given  by 


^al 

^ 

0 

^a2 

= 

0 
-1 

^3 

^= 

K  :; 

a3 

z" 

(3.120) 


ss 


Error  in  the  position  will  thus  be  completely  eliminated. 
The  equilibrium  state  is  now  checked  for  the  case 
without  integral  feedback.   Recalling  Equation  (3.98),  the 
equilibrium  state  is  given  by 


H: 
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t2  =  ^ 


^1  ^1  +  ^2  £2  =  z" 


(3.121) 


ss 


which  in  turn  gives 


e,  =  k7^  z" 
— 1    1  —  ss 


^2  =  ° 


for  nonsingular  K  .   Again,  with  z^" 


(3.122) 


7^  0,  the  system  will 
ss   —       ^ 


always  have  steady  state  position  error. 

It  should  be  noted  that  for  the  augmented  system, 
the  Lyapunov  equation  is  given  by 


a"^  P   +  P   A   =  -Q 
a   a    a   a     a 


(3.123) 


where 


'j< 


A  ,  P  ,  and  Q   e  R 
a   a      ^a 


3nx3n 


Also,  v   is  now  defined  as 
—a 


V  =  B  P   e 
—a    a   a  —a 


(3.124) 


Controllers  u"  in  Section  3.3.2  are  valid  for  the  augmented 
-P 


system  since  u' 
^  -ap 


The  closed-loop  augmented  system 


for  each  case  satisfies  Corollary  3.1,  hence  it  is  also 


- '  >. 


L 
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globally  asymptotically  stable.   It  can  be  shown  that  it  is 
also  asymptotically  hyperstable. 

Recalling  Corollary  3.3,  solution  P   of  Equation 

3. 

(3.123)  will  be  unique  if  all  eigenvalues  of  A  has  negative 
real  parts;  A  and  its  characteristic  equation  are  given  by 

Si 


A   = 
a 


^al    ^a2    ^a3 


-I 


det[sl  -A  ] 

Si 


=  s   det 


si  ""K  «      K  ,  H   :r  K  - 

a2   s   al    2   a3 
s 


(3.125) 


where  I  is  the  identity  matrix;  its  order  is  3n  on  the 
left-hand  side  of  the  equation;  otherwise,  it  is  of  order  n, 
If  K  .  £  R     is  diagonal 

3.  J- 


^ai  =  ^i^^  f^ai;j^ 


where  K  ._  .  denotes  the  element  (j,j)  of  diagonal  K  ., 
a X ;  3  ax 

i   =    1,2,3;    j    =    1,2, ...,n,    then 


"^  3  2 

det[sI-A    ]    =      n       (s     -K    T     .s     -K    T      .s+K    ^     .) 
a  .    ^  a2;]  al;:  a^n 

(3.126) 


>•  >  ^' 
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Again,  the  time- invariant  part  of  the  error-driven 

augmented  system  will  be  decoupled  if  K  ,,  K  t,  and  K  , 

ax   a  ^       a  o 

are  selected  diagonal.   This  does  not,  however,  mean  that 

the  manipulator  dynamics  is  decoupled.   Forming  the  Routh 

array  for  Equation  (3.126),  K  ,  .,  K  „  .,  and  K  ,  ., 

ax ; J        az ; j  ao ; j 

j  =  1,2, ...,n,  must  satisfy  the  following  conditions  for 
all  the  roots  of  Equation  (3.126)  to  have  negative  real 
parts: 


K  -,  .  <  0 
a2;3 


Ka3;j  >  °  (3-127) 


K      K  -  .  >  K  ,  . 
al;j   a2;3     a3;: 


■\n 


..? 


CHAPTER  4 
ADAPTIVE  CONTROL  OF  MANIPULATORS 
IN  HAND  COORDINATES 


In  this  chapter,  manipulator  dynamics  is  expressed 
in  hand  coordinates  and  an  adaptive  controller  with  a 
disturbance  rejection  feature  is  given  for  this  system. 
The  term  hand  coordinates  is  used  to  mean  that  the  hand 
position  and  orientation  (i.e.,  configuration)  of  the 
manipulator  hand  (the  n    link)  is  expressed  in  the 
ground-fixed  reference  frame.   In  the  literature,  hand 
coordinates,  task-oriented  coordinates,  operational  space, 
and  task  space  are  used  interchangeably. 

The  reason  for  the  representation  of  system 
dynamics  in  hand  coordinates  is  that  error  in  hand 
configuration  will  be  directly  penalized  rather  than 
achieving  it  indirectly  through  feeding  back  the  joint 
errors.   Hence,  the  rationale  is  that  overall  measure  of 
error  in  hand  position  and  orientation  will  be  less  when 
equations  are  expressed  in  hand  coordinates  rather  than 
expressing  them  in  the  joint  space.   Since  for  most 
applications,  precision  of  the  hand  movement  has  higher 
priority  than  that  of  the  joints,  this  approach  may  yield 
improved  end  effector  response. 


'-  ■■-;'i 

1-  ^ii 
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4.1   Position  and  Orientation  of  the  Hand 
The  most  useful  presentation  of  the  hand  position 
is  through  its  Cartesian  coordinates  expressed  in  the 
ground-fixed  frame  Fq  defined  by  its  basis  vectors 
{u|°^,  U2°^,  U3°^}.   Common  practice  to  define  the 
orientation  of  a  rigid  body  is  the  use  of  Euler  angles 


X,,    B,  and  ^.   Keeping  in  mind  that  the  frame  F^  defined  by 
basis  vectors  {ui^^ ,  U2   /  u^   }  has  been  fixed  to  the 
hand,  the  Euler  angles  ?,  B,  and  C  are  shown  in  Figure  4.1, 


^3 


.-(n)  • 


u 


u 


(o) 


(n)" 


-(n)"   -(n) 
^2     ^3 


u 


u 


(o) 


(n) 


(o)    -(n)'  -(n)"   -(o) 


^1  ■  '^1 


u. 


'^■\ 


Figure  4.1   Successive  Rotations  of  Frame  F 


Assuming  that  initially  frames  Fq  and  F^  (denoted 
by  F  for  the  initial  position)  were  coincident,  first  F^ 
is  rotated  about  ui    by  ? .   Let  the  rotated  frame  F^  be 


denoted  by  F'  with  basis  vectors  {u, 
n  1 


(n)  ' 


u- 


(n; 


the  rotation. 


The 


a^'"^'}  after 
(n)  ' 


n,  F'  is  rotated  by  S  about  u,     to 
n  1 


■-'4k 


•■•  ''•-■5 
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r '^  (n)  "   -  (n)  "   -  (n)  "i 
obtain  F"  with  basxs  vectors  iu,    ,  u^    ^  u-,    }. 
n  1    '   2      3 

^  (n)  " 
Finally,  F"  is  rotated  about  u^     bv  ^  to  obtain  F„ .   These 
-^    n  3      "  n 

successive  rotations  are  illustrated  in  Figure  4.1.   Now, 
the  basis  vectors  {n}^    ,    u-^    /  ^3   ^  °^  ^n  ^^^^^  undergoing 
the  above  rotations  will  have  the  following  representations 
{u„,  ,  Utto>  Hfn-^  ^^   frame  F„  (subscript  H  denotes  the  hand) 


u 


•HI 


cos?  cosC  -  sine  cos3  sin^ 
sine  cos^  +  cosC  cos3  sinC 
sin3  sinC 


u 


H2 


-cose  sin^  -  sine  cosB  cosC 
-sine  sin^  +  cose  cosB  cosC 
sin6  cos? 


(4.1) 


sine  sin£ 


u„-.  =   -cose  sinB 

— ^H  J 


cosB 


Hence,  nine  parameters  define  the  basis  vectors  of 
F   of  which  only  three  are  independent.   Various  approaches 
exist  in  the  literature  to  represent  hand  orientation  using 
these  parameters.   However,  for  our  purposes  an  expression 
for  the  orientation  error  of  the  hand  is  needed.   As  Luh, 
Walker,  and  Paul  suggest  in  [3  5] , 


1 
2 


J,      ^Hh  i  ^  ^H  i^ 
1=1    p      r 


(4.2) 
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may  be  used  to  represent  the  orientation  error  with 

Utt    •    •  Utt    •    >   0,    i   =    1,2,3.      In   Equation    (4.2)    subscripts 

-Hpl   -HpX 

p  and  r  represent  the  plant  and  the  reference  model, 
respectively,  where  u„.  is  given  by  Equation  (4.1). 
Position  error  will  be  given  by  the  difference  between  plant 
and  reference  model  hand  positions. 

4.2   Kinematic  Relations  between  the  Joint 
and  the  Operational  Spaces 

4.2.1   Relations  on  the  Hand  Configuration 

Following  analysis  is  given  for  nonredundant 

manipulators.   Although  it  can  be  extended  to  redundant 

manipulators,  the  following  treatment  is  applicable  to 

6-link,  6  degree-of -freedom  spatial  (n  =  6)  and  3-link, 

3  degree-of -freedom  planar  (n  =  3)  manipulators.   This 

restriction  is  valid  only  for  the  rest  of  this  chapter. 

Position  vector  z„  originating  at  the  origin  of 

n 

F^  and  pointing  a  point  H  in  the  hand  is  given  by 


^H  =  ^1^1  ^  J^     f^k-1  ^k-1  "•  ^k^k^  "■    VO     (4.3) 
k=2  n 


where  z„,_   is  the  position  vector  connecting  the  oriqin  of 
H/0^ 

frame  F  ,  0  ,  to  point  H  in  the  hand  and  other  parameters 
are  as  defined  in  Chapter  2.   Representation  of  z^  in  Fq,  z^^, 
will  result  in  m,  nonlinear,  coupled  algebraic  equations  in 
terms  of  the  generalized  joing  displacements  £ 


^1. 
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^H  =  ^(9.)  (4.4) 

mi  n 

where  z^^  e  R    and  0_  e  R  .   In  this  chapter  n  is  still  used 

to  denote  the  number  of  links  and  the  variables  m, ,  m„ ,  m 

are  introduced  to  prevent  repetition  of  referring  to  n  =  3 

and  n  =  6  separately. 

For  6-link  spatial  manipulators 


m,  =  3 

m2  =  3  (4.5) 

m  =  m,  +  m-  =  6     and 
for  3-link  planar  manipulators 
m^  =  2 

m2  =  1  "  (4.6) 

m  =  m,  +  m^  =  3 

Hand  orientation  is  given  through  the  orientation  of 

^1-   1-   •      ±.  r'"(n)   ^  (n)   '^  (n)  •,  .  j  ■   r^ 

the  basis  vectors  lu,   '  ^o   '  ^?   -■  i^^P^^sented  m  F. 


0* 
mixmi 


This,  in  turn,  is  given  by  the  rotation  matrix  T   e  R 
as  defined  by  Equations  (2.3)-(2.6) 


T^  =  T  (6)  (4.7) 

n     n  — 


If  the  orientation  of  hand  is  specified  through  the  Euler 
angles  c, ,    6,  5,  then  the  basis  vectors  will  be  given  by 


■% 
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b" 


U^U,    6,  K)    =    [Uj^i    Uh2    Hh3^ 


(4.8) 


where  u„,  ,  u  p,  and  u„-<  are  given  by  Equation  (4.1).   Hence, 


T^(e)  =  Ujj(?,  6,  C) 


(4.9) 


will  yield  set  of  m,  nonlinear,  coupled  algebraic  equations 
of  which  only  m-  are  independent. 

Note  that  for  the  3-link  planar  manipulator  only  one 
Euler  angle,  say  C,  is  needed  to  specify  the  hand 
orientation.   Substituting  3  =  0  and  5  =  0^  ^-ui^r    B,    O  will 

n 

take  the  familiar  form 


cos?    -sin?     0 

sin?    cos?     0 

0       0      1 


m-i  xm-i 
For  this  case  U„(c,]    t    K    -^      ■^,  m,  =2,  will  be  defined  as 


U„(C)  = 


cos?    -sm? 


sm? 


cos? 


(4.10) 


xn 


and  mp  =  1  equation  will  be  independent  out  of  m  =  4  i: 
Equation  (4.9)  . 

Equation  (4.4)  yielding  m,  equations  augmented  with 
the  m-  independent  equations  of  Equation  (4.9)  will  give 


f  (x^)  =  X* 


(4.11) 
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where 


x^  =  e  £  r" 


X*  e  R   is  the  specified  hand  position  and 
orientation  expressed  in  frame  F- 

In  general,  f  maps  R^  into  r"^.   If  R"'  represents  a  subspace 

0 
of  R  which  is  identical  with  the  hand's  work  space,  then  f 

maps  R^  onto  r"^.   However,  in  general,  inverse  correspondence 
w 

f°   of  r"^  (or  R^)  to  R^  does  not  constitute  a  mapping. 
—  w 

Hence,  the  forward  problem,  that  is,  given  x  ^^ ,  finding  x*, 
is  straightforward  and  x,  can  be  determined  for  any  x , . 
However,  the  inverse  problem,  that  is,  given  x , ,  find  x^, 
may  or  may  not  have  a  finite  number  of  solutions.   Also 
inverse  problem 


n-1 


where  superscript  -1  here  denotes  the  functional  inverse, 
in  general,  cannot  be  solved  explicitly  for  x , . 

4.2.2   Relations  on  Hand  Velocity 
and  Acceleration 

The  absolute  linear  and  angular  velocities  of  the 

hand,  v  and  ^/q'  respectively,  are  given  by 


t  . '.■;-y 
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n 


(4.13) 


^H/0  =   "^n   ^ 


(4.14) 


where  w  = 


_n   th  mixn 

e  K  ,  3    column  of  G^   e  R     is  defined  by 


[Gh„].  = 


n  D 


th  . 
s.  X  z„  ,-  ,  if  3    joint  IS  revolute 


s  . 


..  .th  .  .  ^  . 
,  if  j    joint  IS  prismatic 


(4.15) 


Zjj /Q  _  is  as  given  by  Equation  (2.29)  with  C  replaced  by  H, 

th  m2xn 

the  3    column  of  G  e    R  ,  [G  ] .  is  defined  by  Equation 

(2.37)  with  i  =  n.   Combining  Equations  (4.13)  and  (4.14) 


^2   ~   "^^^l^    -2 


(4.16) 


where 


*  T         T         T 

^2    =    ^^H'    ^H/O^ 


(4.17) 


™1  ^2         *  m 

V      e    R      ,    0)-./^  £  R      ,    x„    e    R      with  m  =  m,    +  m„ , 


J   =   J(x^)    = 


Gjj  (x^; 

n 


G    (x,  ) 
n  —1 


£    R 


mxn 


(4.18) 


'N'- 
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,  T    T>T    „2n        -       „n 
X  =  (x,  ,  X2)   £  K   '  ^-i  3"<^  X2  e  R 


(4.19) 


X  =  (x*  /  x_  )   e  R   '  2ii  ^'^'^   Xp  e  R       (4.20) 


x,  denotes  the  generalized  joint  displacements,  whereas  x* 
represents  the  position  and  orientation  of  the  hand  in  the 
fixed  frame  F». 

The  Jacobian  J  in  Equation  (4.16)  is  given  in  terms 
of  joint  displacements  x , .   Introducing  Equation  (4.12) 
into  (4.18) 


J*  =  J*(x*)  =  J(f°    (x*))  = 


,-1 


H 


(f 


(X*)) 


n-1 
Gn  (f     (X*)) 


e  R 


mxn 


(4.21) 


symbolically, Jacobian  J*  is  expressed  in  hand  coordinates 
X, .   Throughout  this  chapter  all  functions,  when  expressed 
in  hand  coordinates  x ^^ ,  will  be  denoted  by  superscript 
asterisk.   Hence,  Equation  (4.16)  could  be  represented  by 


*      0      * 
^2  ~  "^  ^-  ^-1^  ^  -2 


(4.22) 


or 


^2  ~  '^*  ^-1^  -2 


(4.23) 


•J>' 
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Expressions  for  the  hand  acceleration  is  obtained 
differentiating  Equation  (4.16)  with  respect  to  time 


k*   =  J    (x^)  X2  +  J  (x^)  X2 


(4.24) 


th 


mxn  . 


where  the  (i,  j)    element  of  J  (x, )  e  R    is 


[J 


n   8J.^ 


-1   10    k^i  3x^^j^    2, 


(4.25) 


Defining 


i  =  1,2, ...,m;   j  =  1,2, ...,n 


'^k^ 


8J 


kl 


39. 


3J 


kl 


39. 


3  J 


kl 


39 


n 


3J 


k2 


30. 


3J 


k2 


39. 


3J 


k2 


39. 


n 


3J 


km 


30. 


3J 


km 


39. 


3J 


km 


39. 


n 


(4.26) 


J^  =  Jy.    (x^)  e  R"^""^,    k  =  1,2, 


,m 


■^-'■. 
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J (x^ '  ^2 )  = 


T       T 

^2    ^1 


^2 


x~    J 
—2    m 


£  R 


mxm 


(4.27) 


Given  joint  displacements  x-,,  hand  velocity  x_ ,  and 
acceleration  x~,  corresponding  joint  velocities  X2  and  joint 
accelerations  x-  can  be  solved  from  Equations  (4.16)  and 
(4.24),  respectively,  provided  that  the  Jacobian  J  (x, )  is 
nonsingular . 


^2 


J    (x  )  X2 


(4.28) 


^2 


J   (x-,)  X 2  -  J   (x,)  J  (x,,  x^)  J   (x-,)x^ 


where 


(4.29) 


J(Xj^,  x|)  = 


x*^  J  ■^'^    (x^)  J^  (x^) 


x*   J     (x^)    J^  (x^) 


£  R 


mxm 


(4.30) 


.■M 


'  /. .' 
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Substituting  Equation  (4.12)  into  Equations  (4.28)-(4.29), 
X2  and  X2  can  be  determined,  given  x * ,  xtr    x*  from 

X2  =  J*""*"  (xj)  X*  (4.31) 


where 


X2  =  J*"^(x*)  x*- J*-^  (X*)  j*  (X*,  X*)  J*"^(x*)x 

(4.32) 


J*  "^  =  J  -^  (f°    (X*))  _         (4.33) 


J*  (x*,  X*)  =  J  (f°    (X*),  X*)  (4.34) 


4.2.3   Singular  Configurations 

The  Jacobian  given  in  Equation  (4.18)  will  be 
singular  at  certain  configurations  of  the  manipulator  called 
singular  configurations.   At  these  configurations  the  hand's 
mobility  locally  decreases  (i.e.,  less  than  m) ,  hence,  the 
hand  cannot  move  along  or  rotate  about  any  given  direction 
of  the  Cartesian  space.   This  is  anticipated,  since  the 
degree  of  mobility  of  the  hand  is  the  rank  of  the  Jacobian 
and  det[J(x, )]  =  0  at  singular  configurations,  i.e., 
rank [J (x, )]  <  m. 

Essentially,  singularity  of  Jacobian  is  a  geometry 


problem  and  the  associated  singular  configurations  are  the         ■>;=;; 
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property  of  a  given  manipulator.   Hence,  this  problem  has 
to  be  addressed  first  at  the  design  stage  of  each  manipulator, 
That  is,  elimination  of  singular  configurations  as  much 
as  tolerable  by  other  design  requirements  through  the 
change  of  kinematic  parameters  and  the  identification  of 
all  remaining  singularities  are  (or  should  be)  part  of  the 
design  process.   So  far,  this  aspect  is  ignored  in  the 
design  of  industrial  manipulators.   This  identification  will 
define  certain  subspaces  of  the  manipulator's  workspace  in 
which  manipulator  undergoes  singular  configurations.   Once 
these  subspaces  are  identified,  the  complementary  of  the 
union  of  these  subspaces  in  the  work  space  will  define 
subspaces,  or  safe  regions,  in  which  manipulator  will  avoid 
singularities . 

In  view  of  above  discussion,  singularity  avoidance 
which  is  purely  based  on  geometric  considerations  need  to 
be  checked  beforehand  and  the  commands  which  avoid 
singularities  should  enter  the  controller.   At  this  point 
it  will  be  assumed  that  variations  in  the  hand  configuration  . 
in  reaching  the  command  configuration  also  lie  in  the  safe 
region.   That  is,  a  singularity-free  command  which  lies 
close  to  the  border  of  a  singularity  subspace  may  cause 
the  manipulator  to  undergo  a  singularity  configuration  in 
reaching  the  command  configuration.   Above  assumption, 
however,  requires  that  the  command  is  so  generated  and 


Ill 


executed  that  no  singularities  are  met.   It  should  be  noted 
that  the  variations  in  hand  configurations  which  are 
required  to  be  singularity  free  will  depend  on  the  system 
transient  response  as  well  as  the  disturbances  acting 
on  the  system. 

Although  assiomed  otherwise,  if  the  hand  still 
undergoes  a  singularity  configuration,  this  level  of 
control  is  not  equipped  with  a  remedy.   It  is  not  the 
intent  of  this  level  controller  to  avoid  singularities, 
but  to  execute  the  singularity-free  commands.   In 
application,  if  the  destination  configuration  is  not 
reached  within  an  anticipated  duration  (system  error  cannot 
be  reduced  to  an  acceptable  precision  in  a  tolerable  time 
period) ,  then  the  controller  should  activate  the  emergency 
stop  and  generate  a  warning  signal  to  the  operator.   This 
precaution  will  be  built  in  and  operate  whatever  the  reason 
may  be,  including  the  singularity  configurations. 

4.3   System  Equations  in  Hand  Coordinates 
4.3.1   Plant  Equations 

State  equations  of  the  plant  expressed  in  hand 
coordinates  are  obtained  substituting  Equations  (4.12), 
(4.31),  and  (4.32)  into  Equation  (3.1) 


-P 


:o] 


mxm 


[il 


mxm 


J*A*"^G*  J*A*  -"-F*  +F* 
p  p    P   p  p    Ip   2p_ 


X*  + 
-P 


'tO] 


mxn 


J*A*-1 
P  P 


u* 
— P 


(4.35) 
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As  usual,  subscript  p  is  reserved  only  to  denote  the 
"plant";  it  must  not  be  confused  with  a  counter  which  is 
always  denoted  by  letters  i  through  £ .   Similarly,  subscript 
r  is  reserved  for  the  "reference"  model  parameters. 
Referring  to  Equation  (4.35), 


4 '  <'  ^;2>''  '^-^^i 


X*,  e  R^,    X*-  e    R"^  as  defined  before, 
-pi       -p2 


u*  £  R   is  the  control  vector, 
-P 

a'-'     (X*,)  =A-1  (f°"'  'V"  .  r"         '"•"' 

P         -Pl  P       - 


G*  {x*J  e  R^^™  is  defined  symbolically  such  that 
P  -pl 


-*  (X*,)  =  G*  (x*J  X*  (4.38) 


g   IX  ,  ;  =  G   ^x  ,   X  , 
^  ^1      p   — pl   -pl 


and 

,-1 


*  I,,* 


0    ,  * 


where  g  (•)  is  defined  by  Equation  (3.6),  hold.   Similarly, 

F*   (x*,,  X*-)  £  r"^"*  is  so  defined  that 
Ip   — pl   -p2 
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■  *   /.  *    .  * 


holds;  f*   (x  ,,  X  2)  is  given  by 


(4.41) 


f  (•)  is  defined  by  Equation  (3.9),  and 
-P 


2p 


T   _*-lT  T*   T*~i 
-^2   p      pl   P 


T   ^*-lT  T*   ,*-l 
^p2  Jp    ^pn  Jp  . 


e  R 


raxm 


(4.42) 


where 


r*. 
Pi 


.-1 


r*. 
pi 


j:..  =  j:.   (x*j  =  J  ,   (f 


-pl' 


pi 


^4i^ ) 


(4.43) 


J  .  is  as  given  by  Equation  (4.26);  i  =  l,2,...,m;  [0]^^^^, 

ro]    ,  and  [I]     represent  m  xm  and  mxn  null  matrices 
^   mxn'        mxm   '^ 

and  mxm  identity  matrix,  respectively. 

Since  f   (x, )  =  x * ,  in  general,  cannot  be  inverted 

ic  ie  if  ic 

explicitly,  closed-form  expressions  for  J  ,  A  ,  G  ,  F^^  , 

and  F*   as  functions  of  x*  cannot  be  obtained.   Given  the 
2p  -p 

hand  configuration  x*,  and  velocity  x  2/  one  has  first  to 
solve  f°  (x,)  =  X*  numerically  for  joint  displacements  x^^, 
then  calculate  J  ,  J~  ,  and  finally  compute  A^,  G^,  F^^p, 
and  F-  .   Although  equations  are  symbolically  represented 


■«Ax 
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1 
■A 


in  hand  coordinates,  their  implementation  still  needs  the 
joint  displacements,  i.e.,  the  inverse  problem  solution. 
This  represents  added  calculation  in  forming  the  dynamic 
equations  other  than  the  calculation  of  J  and  J  . 

IT  IT 

4.3.2   Reference  Model  Equations 

Reference  model  state  equations  expressed  in  hand 
coordinates  are  given  as  follows: 


^r  = 


[0] 


mxm 


J*    A*~^    G* 
r      r  r 


[I] 


mxm 


J*A*    -^F*      +F* 
r   r        Ir        2r 


■[0] 


mxn 


r   r 


u 


(4.44) 


Definitions  of  all  variables  are  the  same  as  Equation  (4.35); 
this  time  variables  refer  to  the  reference  system  instead  of 
the  plant.   Equations  (4.36)  through  (4.43)  are  valid  for 
Equation  (4.44)  when  subscript  p  is  replaced  by  r.   The 
reference  model  produces  the  desired  response  for  the  plant 
to  follow.   It  should  be  noted  that  functional  dependencies 
are  omitted  in  Equations  (4.35)  and  (4.44). 


rff. 


4.4   Adaptive  Control  Law  with 
Disturbance  Rejection 

Error  between  the  plant  and  reference  model  state 

vectors  for  the  augmented  system  is  defined  by 
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e,  =  e,  (t)  =  X  ,  -  X  T 
—1   —1      — rl   —pi 


52 


e*(t) 


* 
X   T 

— r2 


-  X 


■p2 


(4.45) 


•  * 

^3 


e* 
-3 


=  -I  e 


-1 


I  e*  dt 


(4.46) 


e*  =  (ef ,  ef ,  ef  )^  s  R^"^ 


(4.47) 


Letting  u*  =  u*'  +  u*" 
^  -P   -P    -P 


(4.48) 


u*'  =A*J*"^[J*A*"^G*x%  +  (J*A*"^F*  +F*  )  x%  -K,e* 
-^  p  p   ^  r  r   r— rl    r  r    Ir    2r  — r2    1—1 


K^el    -   K^e^] 


(4.49) 


augmented  error-driven  system  equations  will  be  obtained 
subtracting  Equation  (4.35)  from  Equation  (4.44)  and 
substituting  Equations  (4 . 48 ) -  (4 . 49)  as 


4*  =  A*e*  +  B*z*  -  B*J*A*-V" 

p  p   -p 


(4.5o; 


where 


A*  = 


0 


K,    K 


1 

-I 


K 


B   = 


(4.5i: 


■M 


m 


LiSi 


"^ 
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K,  ,  K-,  and  K^  e  j^mxm  ^^Q^stant  matrices  to  be  selected. 


*    n3mx3in  „*        nSmxn 


A*  £  R-^"'^-^"^  b'  £  R-""^",  0  and  I  denote  the  null  and 
identity  matrices  of  appropriate  dimensions, 

z  =  -J  A   G  X  T  -  (J  A   F,  +F_  )  x^~ 
-      P  P   P-Pl     P  P    IP    2p  -p2 


+  J*A*"^u*  (4.52) 

r  r  — r 


Note  that  subscript  a  is  omitted  in  this  section  previously- 
used  to  denote  the  augmented  system.   Now,  u   will  have 
the  following  structure 


4"  =  ^-^P  ^  '^P  4"-  <^  <^  4 


(4.53) 


K*  =  [G*  :  F*   +  A*J*  ^F*  ]  (4.54) 

p    "•  p  •   Ip     p  p    2p 


AK;  =  [RiV*(S,x;^)^  :  R2V*(S2x;2)^]         (4.55) 


<  =  tAj^r'^X'^  ^'-''^ 


AkJ  =  [R3VNS3U*)']  (4.57) 

(^)  denotes  the  calculated  values,  K*  and  AK*  e  R     , 
K*  and   K*  e  R^^^ ,    R. ,    S.,  i  =  1,2,3,  are  as  defined  by 
Equations  (3.69)  and  (3.70)  with  the  exception  that  S^  and 
S2  e  R"^ 


ti^?. 


':■;*■■ 
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V  =  B  P  e 


P*  e  R  "^  "^  is  the  solution  of  the  Lyapunov  equation 


A*Tp*   +  p*^*      =      _Q* 


(4.58) 


^*        T,3inx3in         -,    _*    .     n 
Q      e   R  and  Q     >    0 


Choosing  a  scalar  Lyapunov  function  of  the  form 

•t 


V*(e*,  t)  =  e*'^P*e  +  2 


(x  ,  S,x  ,  )  dx 
^1  1— pi 


+  2 


0. 


(V   JpAp   R2V  )(Xp2S2Xp2)dT 


+  2 


(v   JpA    R3V  ) (u^  S3U^)dT 


(4.59) 


and  using  Equations  (4.50),  (4 . 52) -  (4  .  57) ,  and  (4.58), 
V  (e  )  will  be  obtained 


V(e)=-e   Qe+2v    z 


(4.60; 


where 


■^ 
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z*'    =   J*A*'^[Ig*  -g*)   +  (f*     -f*    )]   +  (F*     -F*    )    x*„ 
—  P   P        ^P      -^P  — Ip      — Ip  2p         2p      -p2 


+    (J*A*"^  -jV~^A*J*"^J    *A*-^)    u*         (4.61) 
rr  pp        pp        rr— r 


It  can  be  shown  that  bound  on  e  will  be 


iT,,,<2^»-{!4l|.*l^^^  (4.62, 

max 


As   X         (P    )  isdecreased  or   X    .     (Q*)    is   increased  or  i|z*'|| 

max  mm  "—  "max 

is  reduced  through  frequent  updating  of  calculated  values, 
II  e*||     will  be  reduced.   This  augmented  system  will  also 
reject  constant  disturbances  at  steady  state.   Similar 
arguments  on  the  zero  steady  state  error  can  be  given  as  in 
Chapter  3.   The  closed-loop  system  satisfying  V (e  ,  t)  >  0 
and  V(e  )  <  0  will  be  globally  asymptotically  stable  (also 
asymptotically  hyperstable) . 

4.5   Implementation  of  the  Controller 
When  dynamic  equations  are  expressed  in  joint  space, 
information  on  hand  configuration  is  indirectly  supplied  by 
the  reference  model.   Each  given  task  in  hand  coordinates 
will  be  transformed  to  the  joint  space  off-line  and  built 
in  the  reference  system.   But,  when  equations  are 
represented  in  hand  coordinates,  our  immediate  concern  is 
the  hand  configuration,  not  the  joint  variables.   However, 
as  mentioned  before,  given  hand  configuration,  we  are  unable 


^i 


.1 
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to  form  dynamic  equations  directly  without  reference  to 
joint  variables.   Hence,  solution  of  the  inverse  problem. 
Equation  (4.12),  is  needed.   Actually,  this  requirement  is 
not  restrictive,  since  today's  servo-controlled  manipulators 
solve  this  equation  on-line  mostly  using  iterative 
techniques. 

It  is  also  interesting  to  note  that  currently 
direct  measurement  of  hand  configuration  is  not  common,  at 
least  not  feasible  enough  to  equip  today's  industrial 
manipulators  with.   When  equations  are  expressed  in  hand 
coordinates,  normally  a  plant's  (manipulator's)  hand 
configuration  needs  to  be  measured  to  compute  the  error. 
However,  current  implication  is  that,  first,  joint  variables 
will  be  measured,  which  is  a  common  practice,  then  the 
forward  problem.  Equation  (4.11),  will  be  solved  to  find 
the  "measured"  hand  configuration.   It  should  be  noted 
that  system  equations  expressed  in  joint  space  could  be 
used  and  coupled  with  Equation  (4.11)  as  the  output  equation. 
Then,  however,  further  development  of  the  controller  is 
not  immediate. 

Although  equations  are  represented  in  hand 
coordinates, their  implementation  requires  on-line  solution 
of  either  forward  or  inverse  problem.   Forward  solution  is 
needed  if  joint  displacements  are  measured,  inverse  solution 


^ 
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if  hand  configuration  is  measured  directly.   Of  course, 
this  means  more  on-line  computation;  but  considering  that 
the  inverse  problem  is  already  solved  on-line  on  current 
industrial  manipulators  and  that  the  forward  solution  is 
straightforward  (computationally  not  demanding) ,  this 
requirement  is  tolerable  for  implementation. 

Once  the  forward  or  inverse  problem  is  solved, 
implementation  of  the  control  does  not  require  any  more 
significant  computation  compared  to  that  of  Section  3.3.2, 
Controlled  Structure  4,  other  than  J~  .   Since  the 
Jacobian  J  is  assvimed  nonsingular,  existence  of  its  inverse 
is  assured,  but  on-line  computation  of  J   is  the  major 
drawback  of  the  proposed  controller.   One  remedy  to  reduce 
computational  burden  in  finding  J   would  be  forming  J 
symbolically  (i.e.,  each  entry  of  J  is  explicitly  formed 
as  a  function  of  the  manipulator's  kinematic  parameters 
and  the  joint  displacements)  and  then  inverting  it 
symbolically.   Symbolic  formulation  of  various  nonlinear 
functions  containing  a  relatively  large  number  of  terms 
is  studied  in  [44]  .   As  pointed  out  in  that  work,  the  number 
of  terms  in  J  will  significantly  reduce  when  special 
manipulator  dimensions  (zero-link  lengths,  link  offsets, 
and  twist  angles  which  are  mostly  0°   or  90°  for  industrial 
manipulators)  are  introduced. 
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CHAPTER  5 
ADAPTIVE  CONTROL  OF  MANIPULATORS 
INCLUDING  ACTUATOR  DYNAMICS 


So  far  it  is  assimied  that  the  actuator  torques  are 
the  control  variables.   Although  such  a  model  is  easier  to 
study,  it  is  not  physically  realizable,  since  actuator 
torques  cannot  be  assigned  instantaneously.   In  this 
chapter,  manipulator  dynamics  coupled  with  the  actuator 
dynamics  define  the  system  equations.   Actuator  input 
voltages  then  become  the  control  variables.   An  adaptive 
control  scheme  for  this  system  is  also  presented. 

5.1   System  Dynamics  Including 
Actuator  Dynamics 

5.1.1  Actuator  Dynamics 

It  is  assumed  that  n  actuators  drive  an  n-link, 

n  degree-of -freedom  manipulator,  and  that  the  k   actuator 

is  mounted  on  the  (k-1)    link  and  acts  on  the  k    link 

through  a  gear  reduction  box.   It  is  further  assumed  that 

the  actuators  are  permanent  magnet  DC  motors  with  armature 

current  control.   Each  actuator  is  modeled  as  a  third  order, 

linear,  time-invariant  system  with  dynamic  equations 


^k  \  ^  °k  \  +  ^ck  \  -^  -^k  =  ^k  ^Tk  ^k 


^k  ^k  ^  \  ^k  +  ^k  ^k  \  =  ^k 
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(5.1) 
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4- 1^ 

where  the  k   actuator  parameters,  k  =  1,2,. ..,n,  are 


J,   :   Rotor  inertia  referred  to  output  shaft 

JC 


D,   :   Coefficient  of  viscous  friction  referred 
k 

to  output  shaft 

K  ,  :   Compliance  coefficient  referred  to 
output  shaft 


r,   :   Gear  box  reduction  ratio 


K  ,  :   Actuator  torque  constant 


L,   :   Armature  inductance 
k 


R,   :   Armature  ohmic  resistance 
k 


K  1  :   Actuator  back  e.m.f.  constant 
vk 


T,   :   Joint  loading  torque 


'k 


:   Generalized  joint  displacement 


i,   :   Armature  current 
k 

u,   :   Actuator  input  voltage 

If  J*,  d!^,  and  K*.  represent  the  rotor  inertia,  viscous 
friction,  and  compliance  coefficients  of  the  actuator, 
respectively,  then  their  values  referred  to  output  shaft, 
J.  ,  D,  ,  and  K  ,  ,  are  given  by 


"  ■"  .  i/>''.' 
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\  =  ^k°J  ^'-'^ 

^ck  "  ""k  ^ck 

where  r,  is  the  k   gear  box  reduction  ratio.   Although 
Equation  (5.1)  is  given  here  for  permanent  magnet  DC  motors, 
any  type  of  actuator  represented  by  a  third-order,  linear, 
time-invariant  model  can  be  used  without  loss  of  generality. 

In  matrix-vector  form  Equation  (5.1)  is  given 
by 


EqS    +    E2i  +   E^e_  +    T    =    E^i 


i    -   E,6_   -   Eci  =    Lu 


(5.3) 


where 


Eq   =   diag[Jj^] 


E^   =   diag[K^j^] 


E2   =   diag[Dj^] 


E3   =   diag[rj^K^j^] 


E4    =   '^i^gt-^k^vk/^k^ 
E5   =   diag[-R^/Lj^] 


>^ 


'•^ 


t!"' 
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L  =  diag[l/L^] 

i  =  [i^  ±2  ...  i^]^ 

T 
u  =  [u,  U2  ...  u  ] 

E.  and  L  e  R    ,  time-invariant,  diagonal  matrices;  E.  and  L 
are  positive  definite  except  for  E.  and  E_  which  are  negative 
definite;  j  =  0,1,2,. ..,5. 


5.1.2   System  Equations 

Manipulator  dynamic  equations  expressed  in  joint 
space  are  given  by  (see  Sections  2.4.2  and  3.2.1) 


T  =  A  (e)9_  -  f  (e_,  9)  -  g(e)  (5.4) 

Defining  the  state  vector  x  £  R 


x  =  (x  ,  x-,  x_)  (5.5) 


2£i  ~  £'  ^2  ~  — '  — 3  ~  —  (5.6) 


and  substituting  Equations  (5.4)  and  (5.6)  into  Equation 
(5.3),  new  system  equations  will  take  the  form 


X ,  =  X 2  (5.7) 


(5.8) 


:ia 


-4 
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X,  =  E.x^  +  EcX-,  +  Lu  (5.9) 

—3     4—2     5—3     — 


where 


A(x^)  =  Ap(x^)  +  Eq  (5.10) 

A(x,)  e  R^^"  is  positive  definite,  since  A  (x^)  and  Eq 
are  both  positive  definite. 

5.2  Nonlinear  State  Transformation 

Since  Equation  (5.9)  is  the  only  state  equation  which 

contains  the  input  vector  u,  extension  of  previously  given 

control  structures  to  this  system  is  not  immediate.   However, 

the  following  state  transformation  will  facilitate  the 

controller  design.  A  similar  transformation  is  performed  via 

state  feedback  to  decouple  and  linearize  system  equations  through 

nonlinear  term  cancellation  in  [13] .   It  should  be  noted 

that  here  state  transformation  is  not  used  for  this  purpose. 

,3n 


Denoting  the  new  state  vector  y  e  R" 

,  T   T   T,  T 
I  =  (Zi'  l2'  ^3^ 


(5.11) 


(5.12) 
(5.13) 


state  transformation  will  be  defined  by 

^1  =  ^1 

Y2  =  ^2 

Z.3  =  2.(^1'  ^2'  -3^  (5.14) 

where 

a(?ii'^2'-3^  =A~''"(Xj_)  [g(x^)  +f(x^,  X2)  -  E^x^  -  E2X2  +  E3X3] 

(5.15) 
Equation  (5.14)  can  be  written  as 

Z3  =  a^Ii'  Z2'  -3^  (5.16) 
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or  when  solved  for  x^ 

X3  =  q'  (Yi'  1.2'  ^3)  ^^-^"^^ 

where 

2.'(Zi'  Z2'  ^3^  "  E3^[2_(y;L)  +  f(y^,  ^2^ 

+  E^^^  +  £272  +  A  (7^^)73] 

(5.18) 
Differentiating  Equations  (5 .12) - (5 .13)  and  (5.17)  with 
respect  to  time 

X3  =  i'(Yi'  12'  Y3^ 

and  substituting  Equations  (5.18)  and  x^  =  Y^^/  X2  =  72  along 
with  Equation  (5.17)  into  Equations  (5.7)-(5.9),  transformed 
system  equations  become 

ii  =  ^2 

^2  =  ^3 

^3  =  A"-^{  (E^E^)^^  +  (E2E5  +  E3E^  -^1)12 

+  (E^A  -  A  -£2)73  +E5[g(y^)  +f(7i'  72)! 


-  i(Zi)  -i^Ii'  Y2^  ^  ^'"""^^         (5.20) 


] 


•;■:■  m 
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where 


li 


N~^  =  E3L  =  diag[rj^K^j^/Lj,]  e  R'''''' 


(5.21) 


diagonal,  constant  matrix.   Also,  since  E^  and  E.  are 
diagonal  matrices 


E.E .  =  E .E. 
ID     D  1 


E.E.eT   =  E.E.eT   =  E.;  i,j  =  0,1,,.., 5 


Referring  to  Equation  (5.20)  ,  A,  2_,  and  f  are  given  as 
follows: 


(5.22) 


A=    [Ai.]    =5^     A    (y,)   +E 


_d_ 
dt 


^(^1^ 


n 


9  A. 


^ij    =   Ji    ^2,k    ay^^ 


11 
k 


(5.23) 


n  Sg^Ii) 

k=l      ^'^     '^^l,k 


n 


k=l 


9|.(iry2^  9f(Zi'y2^ 


2,k        9y 


l,k 


+  Y 


3,k         9y 


2,k 


(5.24) 


.th 


^n 


where  y.  ,  represents  the  k   element  of  vector  y.  e  R  . 

■^  1 ,  k   '^  —1 

Equation  (5.20)  is  now  represented  in  vector-matrix  form 
and  given  for  the  plant  as  follows: 


:-^ 


M 
'.■*« 
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^P  = 


a"-"-  Gt    a""^  g-   a"-*-  Go^ 

p    Ip    p    2p     P    3p 


y  + 
^p 


A    N 
P    P 


u     (5.25) 
-P 


,nxn 


where  G,  ,  G_  ,  and  G-,   e  R    will  be  defined  such  that  the 
Ip   2p       ip 

following  hold: 


Gip(lp)Zpi  =  E^pE^pYp^  +  E5p2p(^pl) 


G2p(^p)ilp2  =  (^2pE5p^%%-^lp%2 

(5.26) 

+  Et-  f  (y  )  -  g(y  T ) 
5p— p  — p    ^  =^pl 

Go  (y  )y  -,  =  (Ec  A  -A  -E-  )y  ,  -  f  (y  ) 
3p  -^p^S    '  5p  p   p    2p  ^p3   -  ^p 


State  vector  y   is  as  defined  by  Equations  (5 . 11) - (5 . 14) ; 
u  represents  the  actuator  input  voltages.   Subscript  p  in 
Equations  (5 . 25) -  (5  .  26)  indicates  the  plant.   If  subscript  p 
is  replaced  by  r.  Equations  (5  .  25) -  (5  .  26)  will  represent 
the  reference  model  state  equations. 

5.3   Adaptive  Controller 
Actuator  input  voltage  u   has  the  form 


u  =  u'  +  u" 
-P   -P   -P 


■m 
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with 


u'  =  N  A    y   (A~   G.  y  .  -  K.e . ) 


(5.27) 


Following  the  procedure  described  in  Section  3.3.2,  error- 
driven  system  equations  can  be  obtained  as  follows: 


e  =  Ae  +  Bz  -  Ap^Np^u^ 


(5.28) 


In  this  section,  e,  z.  A,  and  B  are  defined  as 


£  =  Zr  "  ^p'  -  ^  '^ 


3n 


Ij  =  y^j  -  Zpj'  3  =  1,2,3;  e.  e  R^ 


(5.29) 


A  = 


Ki    ^2         ^3 


B  = 


(5.30) 


^    _3nx3n   ^    p3nxn 

A  £  K       ,  B  e  K 


^  -1  -1 

z  =  -   y  (G .   y  . )  +  A   N  u 


j  =  l 


DP  -PD 


(5.31) 


K  ,  AK   e  Rnx3n  ^^^   K  ,  AK   e  r"^"  of  the  second  part  of 
p    p  u    u 

the  controller 


'd 


■^^ii 


.r^i 


7^ 


130 


uj   =    (-Kp   +    AKp)    Yp   +    (K^   +    AKJ    u^ 


are  now  given  by 


^  =    t^lp    =    ^2p    =•    Sp] 


AKp   =    [Ri  vCS^Yp^)^    I    R2v(S2yp2)^    :    ^3^(337^3)^] 

(5.32) 


AK^  =    fR4v(S4U^)    ] 


with  V  =  B^Pe   and  P  e  r-^^^-^'^  is  the  solution  of  the  Lyapunov 
equation  A  P  +  PA  =  -Q,  Q  e  r-^"^-^",  q  >  0,  R^,  and  S^  are 
as  defined  by  Equations  (3.69)  and  (3.70)  with  i  =  1,2,3,4. 
If  the  following  Lyapunov  function  is  used. 


V(e,  t)  =  e'^Pe+2  J    J  (vV  V^R^v)  (^  .S  .  Ypj)dT 


+  2 


0 


(vVV\v)  (u^S4U4)dT 


(5.33) 


global  asymptotic  stability  of  the  closed-loop  system  can  be 
shown. 

The  transformed  state  vector  is  composed  of  joint 
displacements,  velocities,  and  the  accelerations.   Hence, 


'4 
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measurement  of  joint  accelerations  is  the  added  requirement 
in  implementation.   Although  joint  accelerations  may  be 
measured,  it  is  best  avoided  because  of  the  relatively  high 
noise  level  in  these  measurements.   An  added  computational 

•     •  • 

requirement  is  the  evaluations  of  A,  f,  and  g;  in  Equations 
(5.23)-{5.24) .   These  computations  will  slow  down  the 
updating  rate  of  K   in  Equation  (5.32),  hence,  error  bound 

IT 

II  e  L   will  increase  if  computation  speed  is  held  constant. 
Otherwise,  added  computations  are  not  significant,  since 
actuator  dynamics  is  represented  by  linear,  time-invariant 
models. 

The  system  equations,  Equation  (5.25)  can  be 
expressed  in  hand  coordinates  (see  Chapter  4)  and/or  they 
can  be  easily  augmented  to  include  integral  feedback  to 
achieve  disturbance  rejection  features.   The  order  of  the 
system  will  rise  to  4n  (from  3n)  if  integral  feedback  is 
added.   Simplified  actuator  dynamics  and  the  corresponding 
system  (manipulator  +  actuators)  dynamics  which  avoids 
acceleration  measuresments  and  the  calculations  of  A,  f , 
and  2_  are  presented  in  the  following  section.   Integral 
feedback  is  also  added  in  that  section  which  is  otherwise 
a  simplified  version  of  this  section. 

5.4   Simplified  Actuator  Dynamics 
5.4.1   System  Dynamics 

Typically,  rotor  inductivity  will  be  in  the  order 
of  10~^  to  10~^  henry;  hence,  the  actuator  dynamics  may  be 


::1 
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simplified  approximating  L^  -    0  [58] .   This  significantly 
affects  the  actuator  model.   The  third-order  system 
representation  of  actuator  dynamics  of  the  previous  section 
reduces  to  a  second-order  system.   This  eases  the  analytical 
treatment  of  the  problem. 

Actuator  dynamics  of  Equation  (5.1)  will  now  take 

the  form 


^k^k  + 


°k^4^Tk^k^ 


+  Kck\  +  ^k  = 


^k^Tk  ^ 
^k 


u. 


(5.34) 


J\.        -^         S,f^f*m»fii 


where  all  parameters  are  as  defined  in  Section  5.1.1,  or 


^0^  ■*"  ^2^  "^  ^1-  ■*■  -  ^  N'~-'-u 


(5.35) 


E^  and  E,  are  as  given  by  Equation  (5.3)  and  diagonal  E^ 

,  », ,  -1   T,nxn 
and  N'   e  R    are 


El   =   diag 


-    -2-  -    1 

D,  +  r,  K^,  K  ,  — 

k    k  Tk  vk  p 


N'~   =  diag 


■^k'^Tk  =- 


(5.36) 


^^^ 
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Coupled  system  equations  are  obtained  if  Equation  (5.4)  is 
substituted  in  Equation  (5.35) 


-1  "  -2 


(5.37) 


X2  =  A'"'"(x3_)  {3:(x^)  +f(x^/X2)  -E^x^  -E^X2  +N'"-'-u} 

A  is  the  same  as  in  Equation  (5.10);  x,  =  9_,  X2  =  £  are  the 
joint  displacement  and  velocities. 


5.4.2  Adaptive  Controller  with 

Disturbance  Rejection  Feature 


The  plant  equations  directly  follow  from  Equation 


(5.37) 


X  = 

-P 


a'-^(g^  -E,  ) 
p   p   Ip 


^'^^p-v 


X  + 

-P 


A-^N'-l 
P   P 


u 
-P 


(5.38) 


G  and  F   are  as  defined  in  Equations  (3 . 6) -  (3 . 10) . 
P      P 

Similarly,  reference  model  equations  will  be  obtained  if 
subscripts  p  are  switched  to  r  in  the  above  equation. 


Letting 
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^i  =  ^ri  -  ^i'  ^  =  ^'2'  ^i  '  ^ 


n 


and 


with 


^3  =  -^^1 


^3  =  - 


le^^dt 


T    T    T.T 


u  =  u'  +  u" 
-P   -P   -P 


(5.39) 


u'  =  N'A  ■ 
-P     P  P 


Vf^^r-^lr^^rl  +  (^r-^2r^^r2^  "  J 


j  =  l 


K.e. 
3-3 


(5.40) 


the  augmented  error-driven  system  equations  become 


i  =  Ae  +  Bz-  -  Ap^N- -^u^ 


(5.41) 


where 


A  = 


'0     0 


K,    K^    K 


1 

-I 


3 
0 


B  = 


I 
0 


(5.42) 


i"  =  -A;'(^'p-V^pl-'p'^''p-'^V^p2-^^V^r 

(5.43) 


..tiU 


•''■S! 
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The  second  part  of  the  controller,  u",  will  have  the  form 
as  in  Equation  (3.64)  with  K  ,  AK   e  R^^  "  and  K^, 


P    P 


AK  e  R^"  defined  by 
u 


(5.44) 


K   =  [G   -  E,   :  F   -  E'  1 
P    ^  P     IP  •   P     2p 


AKp  =  [RiV(S3_Xp^)'^  :  R2v(S2Xp2)^3 


^u  =  fWr  V^ 


^\   =  fR3Z(S3Uj,)'^] 


(~)  denotes  the  calculated  or  estimated  plant  parameters. 
Equations  (3.39)  and  (3.73)  are  valid  for  this  case,  but 
A  and  B  as  defined  by  Equation  (5.42)  should  be  used. 
The  system  presented  in  this  section  includes 
actuator  dynamics,  the  proposed  controller  rejects 
steady  state  disturbances  and  it  is  easier  to  implement; 
measurement  of  accelerations  and  evaluations  of  A,  f_,  and  g 
are  not  required.   The  solution  of  the  error-driven  system 
will  enter  the  spherical  region  containing  the  origin  of 
error  space.   Hence,  manipulator  response  will  converge 
to  the  desired  response.   Bound  on  the  spherical  region  is 
as  given  by  Equation  (3.82)  with  l|z|  j^^^  replaced  by  II  I'llj^^x' 
z'  is  as  defined  by  Equation  (5.43). 
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CHAPTER  6 
EXA^IPLE  SIMULATIONS 


Proposed  adaptive  controllers  are  implemented  on 
the  computer  and  system  response  is  obtained  under  various 
operating  conditions.   Simulations  are  conducted  on  the 
VAX-11/750  system  at  the  Center  for  Intelligent  Machines  and 
Robotics  (CIMAR) ,  Department  of  Mechanical  Engineering, 
University  of  Florida.   The  program,  mathematics,  library 
and  graphics  package  are  developed  in  FORTRAN  77  and 
supported  by  the  VAX/VMS  operating  system. 

Manipulator  dynamics  is  coupled  with  the  simplified 
actuator  dynamics  and  the  controller  structure  described 
in  Section  4.2  is  simulated  for  various  manipulation  tasks. 
Plant  differential  equations  are  integrated  using  the 
Hamming's  fourth-order,  modified  predictor-corrector 
method.   Inclusion  of  the  disturbance  rejection  feature  is 
left  optional;  the  user  can  select  the  desired  option. 
Although  the  program  is  capable  of  simulating  n-link 
manipulators,  3-  and  6-link  spatial  industrial  manipulators 
are  used  in  the  examples  presented  in  this  chapter.   The 
program  is  developed  independent  of  units;  the  metric  system 
is  employed  in  the  3-link  manipulator  and  the  British  system 
in  the  6-link  arm  examples. 
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Plant  parameters  composed  of  manipulator  kinematic 
parameters  and  actuator  properties  form  the  input  to  the 
program.   These  include  manipulator  link  lengths,  link 
offsets,  twist  angles,  link  masses,  inertias,  center  of 
gravity  locations  of  each  link,  actuator  rotor  inertias, 
coefficients  of  viscous  friction,  compliance  coefficients, 
gear  box  reduction  ratios,  actuator  torque  constants, 
armature  resistances,  and  back  e.m.f.  constants.   A  second 
set  of  the  above  parameters  (possibly  with  different 
numerical  values)  is  also  input  to  represent  the  reference 
model.   In  fact,  the  reference  model  parameters  represent 
the  closest  available  estimates  of  the  plant  parameters  and 
we  do  not  know  the  exact  values  of  the  plant  parameters. 
This  is  simulated  via  discrepancy  in  the  plant  and  reference 
model  parameters  in  the  computer  program. 

Other  than  the  differences  in  the  plant  and 
reference  model  parameters,  the  following  disturbances  are  also 
introduced.   Manipulator  initial  position  is  set  different 
from  the  initial  position  of  the  reference  model.   After  the 
motion  started,  an  extra  pay load  is  added  on  the  manipulator 
hand  and  the  system  response  is  observed  while  the  reference 
model  had  no  information  of  this  payload.   Measurement 
delays  are  simulated  using  time  delays  ranging  betv/een  0.01 

to  5  ms  for  different  examples.   The  values  of  A  ,  G  ,  and 

P   1^ 

F   in  Equation  (5.38)  are  updated  at  various  frequencies 

P 
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from  10  Hz  to  400  Hz  in  the  simulations.  Although  the 
analytical  development  assumed  that  A  in  u'.  Equation 
(5.40),  is  exactly  and  continuously  updated,  numerical 
simulations  updated  A   at  the  given  frequencies. 

Overall  control  structure  may  be  considered  hybrid 

in  the  sense  that  the  terms  in  the  controller  linear  in 

T 
error  and  state  variables  [K^e^,  i  =  1,2,3;  RjVCSjX^j)  , 

rn 

j  =  1,2  and  R.v{S-.u  )   are  meant]  are  supplied  continuously 
J    J  r 

(analog  signal) ,  whereas  the  nonlinear  terms  A^,  G^,  and  F^ 
are  updated  at  the  given  frequencies  only.   This  latter 
part  of  the  input  actually  constitutes  a  train  of  impulses; 
magnitudes  held  constant  during  the  entire  sampling  period 
determined  by  the  input  update  frequency;  hence  introducing 
shocks  to  the  system. 

It  should  be  noted  that  the  theoretical  development 
did  not  address  all  of  these  disturbances  individually  and 
even  the  system  stability  is  not  guaranteed  under  their 
simultaneous  action.   (Error  bound  on  the  system  response 
is  given  before.)   Here,  numerical  simulations  test  the 
proposed  controllers  under  rather  severe  conditions.   The 
magnitudes  of  disturbances  are  chosen  arbitrarily.   The 
maximum  amount  of  the  extra  pay load,  for  example,  which  will 
produce  undesirable  transients  or  even  induce  instability 
is  not  addressed  in  this  study.   Without  further  research, 
proposed  controllers  should  be  extensively  experimented 
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(via  computer  and  laboratory  simulations)  if  large 
disturbances  are  expected.   However,  as  the  examples  below 
reveal,  performance  of  the  controllers  under  the  simulated 
disturbances  is  encouraging. 

6.1   Simulations  on  the  3-Link,  Spatial  Manipulator 
The  3-link  manipulator  used  in  the  examples  is 
depicted  in  Figure  6.1  and  the  related  plant  parameters  are 
given  in  Tables  6.1-6.3. 


imn 


Figure  6.1   Illustration  of  the  3-Link  Manipulator 


Reference  model  manipulator  and  actuator  parameters  that 
are  different  from  the  plant  are  listed  in  Tables  6.4-6.5, 
The  first  simulation  includes  the  disturbance  rejection 
feature,  i.e.,  the  integral  feedback  is  activated.   Hence, 
the  system  order  is  9  for  the  3-link  manipulator;  K^,  K^, 
and  K3  £  V?^^    in  Equation  (5.42)  are  chosen  diagonal 
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Table  6.1   Kinematic  Parameters  of  the  3-Link  Manipulator 

(Plant  Parameters) 


Joint 

^k 

^k 

«k 

No 

(m) 

(m) 

(deg) 

1 

0.1 

0.6 

90.0 

2 

0.1 

0.5 

0.0 

3 

0.0 

0.4 

- 

Table  6.2   Inertia  Properties  of  the  3-Link  Manipulator 

(Plant  Parameters) 


No 


Link   Centroid  Location*   Mass 


(m) 


1  0.20   0.0   0.0 

2  0.15   0.0   0.0 

3  0.20   0.0   0.0 


Inertia 


(kg)    (kg.m  ;  about  centroid) 


20.0  0.20  0.60  0.60 
10.0  0.05  0.20  0.20 
15.0      0.03    0.10    0.10 


*   Expressed  in  the  hand-fixed  reference  frame. 
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Table  5.3   Actuator  Parameters  (Plant) 


Actuator  No 


K 


Tk 


^vk 


(lO'^kg.m^) 
(Nm/rad/sec) 


( Nm/amp ) 

(ohm) 

( volt/rad/sec) 


5.00  5.00  1.00 

0.30  0.30  0.25 

30.00  20.00  10.00 

0.90  0.60  0.25 

1.00  1.00  0.60 

0.50  0.50  0.25 


Table  6.4   Reference  Model  Manipulator  Parameters 


Link     Centroid  Location 
No  (10"^m) 


Mass 
(kg) 


^k 
(m) 


1  204.55    4.55    4.55      22.0      0.65 

2  158.33    8.33    8.33      12.0      0.55 

3  180.00   20.00   20.00      25.0      0.50 


Table  6.5   Reference  Model  Actuator  Parameters 


Actuator  No 


(10~^kg.ra^) 


"q.  (Nm/rad/sec) 

^vk    (volt/rad/sec; 


4.00    4.00    2.00 
0.35    0.35    0.30 

0.55    0.45    0.30 
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=  diag(-160.5   -160.5   -200.0) 


K.  = 


K2  =  diag(-24.5     -24.5    -27.0) 


K3  =  diag(189.0     189.0    300.0) 


so  that  the  eigenvalues  of  the  decoupled  linear  part  of 
the  error-driven  system  are  located  at  -1.5,  -9.0,  -14.0; 

-2.0,  -10.0,  -15.0  with  the  first  three  eigenvalues  having 

9x9 
multiplicity  two.   Also  selecting  the  Q  e  R    matrix 

diagonal 


Q  =  diag(2.0) 


the  solution  P  of  the  Lyapunov  equation 


A  P  +  PA  =  -Q 


is  obtained  as 


P  = 


^    ^2    ^3 


^2    ^4    ^5 


T     T 
P     P     P 
^3     5     6 


(6.1) 


where  P   e  R^^^,  i  =  1,2,..., 6,  and  P.  given  by 
i 
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P   =  diag(  8.3431    8.3431     9.6266) 

P  =  diag(  0.0579  0.0579  0.0646) 

P  =  diag(-8.2905  -8.2905  -11.9188) 

P  =  diag(  0.0432  0.0432  0.0394) 

P  =  diag(-0.0053  -0.0053  -0.0033) 

P^  =  diag(11.7894   11.7894    20.0449) 
6 

The  method  used  in  the  niamerical  solution  of  the  Lyapunov 
equation  is  explained  in  the  following  section.  S^  and 

R   e  R"^^^  in  Equation  (5.44)  are  chosen  as  follows: 

1 

S^   =   diag(0.5  0.5  0.5) 

52  =   diagd.O  1.0  1.0) 

53  =   diag{0.1  0.1  0.1) 

R     =   diag(0.1  0.1  0.1) 

R^   =   diag(2.0  2.0  2.0) 

R3   =  diag(0.1  0.1  0.1) 

Time  delay  in  measurements  is  input  as  5  ms . 
Initial  plant  position  is  set  to  x  ,  =  (20.0   60.0   -115.0) 
deg,  whereas  the  reference  model  position  was  x^^ 
=  (45.0   20.0   -40.0)'^  deg.   One  second  after  the  motion 


T 
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started,  2  0  kg  extra  payload  is  dropped  on  the  manipulator 
hand  (plant).   Figures  6.2-6.4  illustrate  the  system 
response  and  the  actuator  input  voltages  when  nonlinear 
terms  are  updated  at  60  Hz.   The  same  problem  is  repeated 
with  10  Hz,  Figures  6.5-6.7,  and  200  Hz,  Figures  6.8-6.10. 
Smooth  curves  in  the  displacement  and  velocity  plots 
designate  the  desired  path,  whereas  the  second  curve  in 
these  graphs  shows  the  plant  response. 

In  all  three  cases  system  stability  is  preserved, 
reference  trajectory  is  tracked,  and  the  steady  state  error 
is  eliminated  with  the  disturbance  rejection  feature. 
However,  with  10  Hz  updating  rate,  response  of  the  second 
and  especially  the  third  joints  (Figures  6.5b-c,  6.6c) 
deteriorated  compared  to  Figures  6.2b-c,  6.3c  (60  Hz)  and 
Figures  6.8b-c,  6.9c  (200  Hz).   As  expected,  smoother 
actuator  input  voltage  curves  are  obtained  as  the  update 
rate  is  increased  from  10  Hz  to  60  and  200  Hz.   Compare, 
for  example.  Figures  6.7c  (10  Hz),  6.4c  (60  Hz),  and  6.10c 
(200  Hz) .   The  sudden  jump  in  the  input  voltage  curves  and 
the  deterioration  of  system  response  at  t  =  1  sec  is 
because  of  the  addition  of  extra  mass  on  the  manipulator 
hand.   Due  to  the  integral  feedback  action,  system  response 
converges  to  the  desired  path  in  about  0.2  sec. 

The  final  simulation  is  conducted  on  the  same 
manipulator  without  activating  the  integral  feedback. 
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In  this  case  the  system  order  is  6  and  the  A  and  B  matrices 
in  Equation  (5.42)  are  given  by 


A  = 


K,    K, 


B  = 


0" 


(6.2) 


where  A  e  R  ^  and  B  e  R  ^  .   Adjustment  is  made  on  the  K, 

3x3 
and  K2  £  R    matrices  so  that  the  dominant  system 

eigenvalues  are  preserved. 


K^   =  diag(-13.5   -13.5   -20.0) 

K2  =  diag(-10.5   -10.5   -12.0) 

The  corresponding  eigenvalues  are  now  located  at  -1.5  and 
-9.0  with  multiplicity  two  and  -2.0  and  -10.0.   The 
nonlinear  terms  are  updated  at  6  0  Hz.   In  this  example,  S. 
and  R^,  i  =  1,2,3,  are  modified  as  follows  to  improve  the 
transient  response 


S^  =  diag(2.0   2.0   2.0) 


S„  =  diag(2.0   2.0   2.0) 


S,  =  diagd.O   1.0   1.0) 


R,  =  diag(2.0   2.0   2.0) 


R,  =  diag(3.0   3.0   3.0) 


R^  =  diagd.O   1.0   1.0) 
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Choosing  the  Q  e  R  ^  matrix  as  follows 


Q  =  diag(5.0) 


solution  of  the  Lyapunov  equation  is  given  by 


P  = 


P   P 
1    2 


T 
P    P 
^2   ^3 


(6.3) 


where  P^  e  R^^^,  i  =  1,2,3,  and 


Pj_  =  diag(5.3968   5.3968   5.8750) 
P2  =  diag(0.1852   0.1852   0.1250) 


P   =  diag(0.2557   0.2557   0.2188) 


All  plant  and  reference  model  parameters, 
manipulation  task,  and  the  disturbances  are  kept  the  same 
as  in  the  previous  three  simulations.   System  response  and 
input  voltages  are  plotted  in  Figures  6.11-6.13.   The  lack 
of  integral  feedback  is  best  demonstrated  by  the  4  5  deg 
steady  state  offset  in  the  third  joint  displacement  as 
shown  in  Figure  6.11c.   Also  more  than  9  deg  overshoot  is 
introduced  in  the  response  of  this  joint.   Comparing 
Figure  6.2c  (with  integral  feedback)  to  Figure  6.11c, 
overall  measure  of  error  in  system  responses  can  easily  be 
assessed.   First  joint  displacement.  Figure  6.11a, 
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introduces  13  deg  overshoot  compared  to  the  case  with 
integral  feedback.  Figure  6.2a.   Response  of  the  second 
joint  has  about  15  deg  overshoot  and  steady  state  error  as 
shown  in  Figure  6.11b.   The  last  example  clearly 
demonstrates  the  improvements  obtained  in  the  system 
response  when  the  integral  feedback  is  activated  to  reject 
disturbances. 

6.2   Numerical  Solution  of  the  Lyapunov  Equation 
Given  A  and  the  positive  definite  Q,  solution  P  of 
the  Lyapunov  equation 

a'^p  +  pa  =  -Q 

is  obtained  as  follows.   Here,  A  =  [a. .],  P  =  [P . . ] ,  and 
Q  =  ^'^ij^    ^^^   assumed  to  be  of  dimension  kxk.   Expanding 
the  above  equation  and  writing  in  matrix-vector  form 


A*£*  =  -2^* 


(6.4) 


where  A*  e  R^  ^^    ,    p*   e    R^    ,    and  q*  e    R^      ar 


e  given  by 


A*  = 


T 
A     +a^^l 

^21^          1 

•    •    • 

^kl^ 

^12^ 

T 
A     +^22^ 

•    •    • 

^k2^ 

• 
• 
• 

• 

• 

• 
• 

_     ^Ik^ 

^2k^ 

•    •    • 

^"^  ■"  ^kk^ 
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I  represents  the  identity  matrix  of  order  k, 

£  =  [Pii   Pi2   •••   Pik  P21   •••   Pkk^"^ 

^*  =  ^^11   ^12   •♦•   ^Ik  ^21   •••  %K^'^ 

Hence,  solution  of  the  Lyapunov  equation  is  reduced  to  the 
solution  of  simultaneous  algebraic  equations  of  Equation 
(6.4).   Although  numerically  more  efficient  methods  exist  in 
the  literature,  this  method  is  used  in  the  simulations,  since 
the  solution  of  the  Lyapunov  equation  is  required  once  and 
can  be  performed  off-line.   The  solution  is  obtained  by 
means  of  Gauss  elimination  with  complete  pivoting. 

6.3'  Simulations  on  the  6-Link, 
Spatial  Industrial  ManipulatoiT" 

The  6-link,  spatial  industrial  manipulator, 

Cincinnati  Milacron  T3-776,  is  illustrated  in  Figure  6,14 

and  its  kinematic  parameters  and  inertia  properties  are 

given  in  Tables  6.6  and  6.7.   Actuator  parameters  are 

presented  in  Table  6 . 8  and  the  reference  model  actuator 

parameters  that  are  different  from  the  plant  parameters  are 

listed  in  Table  6.9.   It  should  be  noted  that  the  actuator 

parameters  in  Tables  6,8  and  6 , 9  do  not  represent  the 

actuators  used  in  T3-776.   The  order  of  magnitude  of  these 

parameters  are  representative  of  DC  motors  [13,  58],  but 

otherwise  arbitrary. 
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Figure  6.14   Cincinnati  Milacron  T3-776  Industrial  Robot 
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Table  6.6   Kinematic  Parameters  of  the  6-Link  Manipulator 
(Plant  Parameters) 


Joint 

^k 

^k 

^'k 

^min 

^max 

No 

(in) 

(in) 

(deg) 

(deg) 

(deg) 

1 

32.0 

0.0 

90.0 

-135.0 

135.0 

2 

0.0 

44.0 

0.0 

30.0 

117.0 

3 

0.0 

0.0 

90.0 

-45.0 

60.0 

4 

55.0 

0.0 

61.0 

-180.0 

180.0 

5 

0.0 

0.0 

61.0 

-180.0 

180.0 

6 

6.0 

0.0 

- 

-180.0 

180.0 

Table  6.7   Inertia  Properties  of  the  6-Link  Manipulator 

(Plant  Parameters) 


No 


1 

2 
3 
4 
5 
6 


Link  Centroid  Location*   Mass 


(in) 


(Ibm) 


Inertia  about  centroid 

h         h         h 

(lO^lbm.in^) 


0.0 
20.0 
4.0 
0.0 
0.0 
0.0 


Expressed  in  the  hand-fixed  reference  frame. 


0.0 

-17.0 

700.0 

0.0 

0.0 

100.0 

-1.0 

0.0 

1500.0 

20.0 

180.0 

150.0 

-7.0 

0.0 

1000.0 

170.0 

26.0 

170.0 

0.0 

-20.0 

150.0 

2.0 

2.0 

1.2 

0.0 

0.0 

80.0 

0.8 

0.8 

0.3 

0.0 

-4.0 

60.0 

0.4 

0.4 

0.2 
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Table  6.8   Actuator  Parameters  (Plant) 


Actuator  No 


J]^   (10"^lbm.ft^) 
Dj^   (Ibf  .ft/rad/s) 


K^j^  (Ibf  .ft/amp) 

\      (ohm) 

K^^  (volt/rad/s) 


100.00  50.00   50.00  30.00  30.00  20.00 

0.30  0.30    0.20   0.30   0.25   0.20 

100.00  100.00  100.00  80.00  30.00  10.00 

15.00  15.00   10.00   8.00   6.00   6.00 

0.80  0.80    0.80   0.80   0.70   0.60 

0.50  0.50    0.40   0.30   0.25   0.20 


Table  6.9  Actuator  Parameters  (Reference  Model) 


Actuator  No 


Jj^  (10"^lbm.ft^)    :  150.00  45.00  55.00  25.00  25.00  25.00 
D^  (Ibf .ft/rad/sec) :    0.35   0.35   0.25   0.25   0.30   0.25 


'VC- 
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In  this  section,  three  simulations  on  T3-776  are 
presented.   The  first  two  simulations  assume  that  the 
reference  model  hand  carries  5  Ibm  extra  payload  throughout 
the  motion.   Also,  an  additional  5  Ibm  payload  is  added  to 
the  reference  model  at  t  =  0.7  sec  increasing  the  difference 
to  10  Ibm.   Integral  feedback  is  in  effect  in  these 
simulations,  hence  the  system  order  is  18.   The  initial 
reference  model  position  is 

x^-L  =  (-5   100   -25   -90   0   50)^  deg 

The  initial  plant  position  is  set  to 

X  ,  =  (0   50   10   50   -40   0)^  deg 

so  that  the  differences  in  joint  positions  varied  between 

5  to  50  deg.   Diagonal  K.  c    R   ^^    in  Equation  (5.42),  S., 

1  1 

R^  in  Equation  (5.44),  i  =  1,2,3,  Q  e  R"^^^^^,  and  the 

18x1  8 
solution  of  the  Lyapunov  equation,  P  e  R      are  given 

below;  K^,  K2,  and  K^  are  so  chosen  that  the  eigenvalues 

of  A  of  the  error-driven  system  lie  at  -1.0,  -2.0,  -7.0, 

-11.0  each  with  multiplicity  three  and  at  -9.0  v;ith 

multiplicity  six. 

K^  =  diag(-79   -79   -79   -139   -139   -139) 

K2  =  diag(-17   -17   -17   -22   -22   -22) 
K^  =  diag(63   63   63   198   198   198) 
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S.  =  R^  =  diagdO"^),  i  =  1,2,3 

Q  =  diag(l) 

that  is  Q  is  chosen  18  x 18  identity  matrix  and  P., 

j  =  1,2,. ..,6,  as  given  in  Equation  (6.1),  but  now  of 

dimension  6x6,  are  given  by 

Pj_  =  diag(  1.5154  1.5154  1.5154  2.1289  2.1289   2.1289) 

P2  =  diag(  0.0165  0.0165  0.0165  0.0194  0.0194   0.0194) 

P3  =  diag(-1.0552  -1.0552  -1.0552  -2.4528  -2.4528  -2.4528) 

P^  =  diag(  0.0157  0.0157  0.0157  0.0122  0.0122   0.0122) 

P^  =  diag(-0.0040  -0.0040  -0.0040  -0.0013  -0.0013  -0.0013) 

Pg  =  diag(  1.3543  1.3543  1.3543  4.0255  4.0255   0.0255) 

Measurement  delays  are  taken  as  0.01  ms .   Figures 
6.15-6.16  give  the  system  response  and  Figure  6.17  the 
actuator  inputs  when  nonlinear  terms  are  updated  at  50  Hz. 
Later,  this  frequency  is  increased  to  200  Hz  and  the 
response  is  plotted  in  Figures  6.18-6.20.   Again,  smoother 
response  is  obtained  as  the  updating  frequency  is  increased. 
It  is  interesting  to  note  that  the  response  overshoots  are 
either  reduced  in  magnitude  or  completely  eliminated  as 
the  frequency  is  increased  from  50  to  200  Hz.   Joint  6 
displacement,  for  example,  has  3  0.9  deg  overshoot  with  50  Hz 
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updating  rate,  Figure  6.15f.   This  overshoot  is  reduced  to 
3  deg  with  200  Hz  updating  as  shown  in  Figure  6.18f.   Also 
the  joint  5  overshoots  of  6.42  and  5.58  deg  in  Figure 
6.15e  (with  50  Hz  updating)  are  completely  eliminated  when 
the  frequency  is  200  Hz,  Figure  6.18e.   Magnitudes  of  the 
input  voltages  are  also  influenced  by  the  frequency  change. 
Maximum  value  of  the  6th  actuator  input  voltage  is  21.09  v 
(50  Hz)  as  shown  in  Figure  6 .17f,  whereas  the  same  value  with 
the  increased  updating  frequency  (200  Hz)  is  reduced  to 
9.01  V  in  Figure  6.20f.   Faster  updating  also  produced 
smoother  input  curves  as  expected.   Compare,  for  example, 
Figure  6.17  to  6.20. 

The  last  simulation  on  T3-776 — Figures  6.21- 
6.23 — modeled  the  reference  model  so  that  each  link  had  an 
extra  payload  of  10  Ibm.  Also  at  t  =  0.7  sec,  an  extra 
payload  of  30  Ibm  is  dropped  on  the  reference  model  hand. 
In  this  example,  the  nonlinear  terms  are  updated  at  40  0  Hz. 
Due  to  the  increased  difference  between  the  plant  and 
reference  model  parameters,  joint  5  displacement.  Figure 
6.21e,  introduced  10.78  and  4.63  deg  overshoots  (which  were 
eliminated  in  Figure  6.18e)  in  spite  of  the  increased 
updating  rate.   Joint  6  overshoot  in  Figure  6,21f  is  also 
increased  to  9.07  from  3.0  deg.   Further  adjustments  on 
K.,  S.,  and  R. ,  i  =  1,2,3,  may  reduce  the  system  overshoots 
and  improve  the  overall  transient  behavior. 


227 


if'  :' 


■01 


_     cu 


U 

Oi 

m 

CO 

c^ 

0) 

~^ 

E 

iJ3 

m 

— 

<u 

S 

P> 

•H 
E-i 

^ 

tn 

> 

■p 

c: 

.^^ 

0) 

— 

e 

(U 

0 

(0 

iH 

Cu 

m 

en 

■H 

03 

Q 

<S) 


<S) 


_         <Si 


IS) 


-p 

C 

•H 

o 

f-3 


J- 

<N 

J- 

• 

<S) 

vo 

<U 

u 

3 

tn 

nj 

•H 

cu 

fa 

<s 


D. 
1/1 


5> 


est 

s 

•SJ 

ta 

!? 

Si 

Si 

ta 

"a 

<s 

m 


IS) 


m 


■a 


U) 


<s> 


ta 


la 


Ln 


la 
<a 


la 

cu 


<a 


m 

cu 


228 


■m 

TD 


, 

J^ 

^_^^- 

^^^^ 

-- 

^ 

\ 

^ 

1 

-\j 

k 

-1 

i     ^  "^ 

^^ 

■^ 

^ 

^ 

^ 

5» 

OJ 

U 

Q; 

Ln 

CO 

c- 

QJ 

E 

I— 

03 

U7 

•H 

^ 

EH 

> 

c 

_^ 

<u 

.^ 

e 

• 

a) 

0 
(0 

U3 

CD 

•H 

03 

Q 

lO 


<s> 


IS) 


Si 

IS) 


CN 

a 

•H 
O 
1^ 


^ 


J- 

^^ 

J- 

• 

VD 

ISJ 

<D 

U 

3 

Cn 

cu 

•rH 

cu 

fe 

OJ 


in 


3      S 


<SI 


in 

03 


O) 


03 


Ln 


00 


01 


ru 


cu 


03 


CD 


03 


LD 
U3 


<S1 


m 


229 


§ 

OJ 

'— > 

U 

di 

1/1 

CO 

c- 

(D 

— 

E 

lO 

m 

• 

-^ 

(U 

a 

■H 

^c^^ 

EH 

_ 

to 

> 

+J 

C 

■ 

Q) 

.^ 

e 

• 

Q) 

"^^ 

u 

(0 

iH 

cu 

to 

en 

•H 

CD 

Q 

1S> 

n 

■P 

C 

r- 

•H 

03 

0 

la 

f-3 

<Sl 


cu 
ai 


CS9 
(Si 


!S» 


n 


Q. 
1/1 


IS) 


cu 


m 

S 

s 

r- 

— 

m 

:# 

^ 

I 

1 

n 

u 

CM 

3 
•H 


>I3 
CU 


230 


fn 


TJl 


oi 


CO 


^ 


U 
Oi 

1/1 


Oi 


01 
CO 


(S) 


<J3 


J- 


OJ 
OJ 


<s 


e 


> 

4) 

i 

o 

(0 
iH 

cu 

CO 
•W 
Q 


a 

•H 

o 

^3 


iH 
CM 

Cn 

•H 


J- 


CL 
U1 


IS 


IS 


Lf) 


CO 

CU 


CD 
OJ 


U3 


lO 

m 


LD 


OJ 


^ 


m 


en 


CO 


CXJ 

<s 


CO 


J- 


231 


in 

0) 
13 


/ 

r 

/ 

( 

> 

^ 

^ 

^^ 

-^ 

^ 

-^ 

-/ 

y 

1 

i 

1 

^ 

J 

! 

h 

cu 


U 

QJ 

Ln 

CO 

• 

Qj 

— ' 

E 

03 


?5 


(J) 

CO 


<S) 


iXI 


(U 

e 

•H 

E-i 
to 

> 

c 

e 

QJ 
O 
03 
iH 
Qa 

en 

•H 
Q 


C 

•H 

o 

t-3 


J" 

J- 

« 

<x) 

la 

<u 

S-l 

3 

CP 

ai 

•H 

nj 

fr( 

<S) 


<Sl 


LD 


Q. 


CO 


>Sl 


nj 


uo 


H^ 


OJ 


n 


en 

en 
I 


fe        H3 


in 


U3 


232 


/ 

I 

\ 

i 

— V — 

/ 

1 

/ 

s 

\ 

^ 

::^ 

^\ 

) 

( 

/ 

"^ 

\\ 

-X 

CD 


U 


Oi 


03 

in 

• 

«>4 

0) 

g 

-H 

^ 

&^ 

_d 

(0 

> 

+J 

c 

^^ 

0) 

• 

§ 

-^ 

0 

(0 

rH 

a 

m 

cn 

•H 

CO 

Q 

<s» 

VD 

■P 

c 

c^ 

•H 

03 

0 

<a 

Id 

S) 


IS) 


<Sl 


^-^ 


± 

• 

vo 

o 

<a 

U 

3 

D< 

cu 

•H 

cu 

b 

lD 


Q. 

in 


<S) 


m 


^  S  ^ 


CD 


VJO 
U3 


Ln 


(SI 


(S> 


cu 
<s> 


cu 

cu 


IS 


<Sl 


<Sl 


v'4 


233 


in 


-] *"v 


OJ 


U 

Oi 

in 

CO 

c- 

01 

-* 

E 

?i 


en 

CO 


<Sl 


lO 


_      <s» 


OI 

cu 


<s> 


(U 

S 

•H 
EH 

0] 

> 
+) 

•H 
U 

o 

> 


c 

O 


(0 

OJ 

0) 
U 

•H 


_-l     ta 


_^ 

a 

en 

m 

ai 

$ 

H3 

la 

la 

"a 

1 

1 

(a 
1 

1 

.— 1 

> 

S  85 


en 


cu 


s^ii^ 


234 


::t5: 


^ 


F 


i/i 


nj 


r 

1 

1 

r 

1 

1— 



^ 

r 

i 

i 

W 

/ 

1 

1 

1 

( 

1 

\ 

1 

i 

i 

IS 


OJ 


CO 


?5 


u 

Oi 


QJ 


OJ 
CO 


IS) 


S) 


<S) 


cu 
nj 


IS) 
(S) 


<s> 


CO 


rn 


S5  ig 


en 


cu 


cu 


tS) 


IS) 


s 


a! 


cu 


lO 

J- 


S 


0) 

s 

•H 

&^ 

(0 

> 

+J 
•H 
O 
O 

■H 


CN 

(3 
•H 
O 

1-3 


CM 

■ 

(U 
M 
3; 
Cn 
•H 


Qj 


pj 


^^ 


-^S' 
.•=^' 


235 


^^ 


in 


— » _ 

- I 


nj 


03 


u 

Oi 
in 


Oj 


CO 


tS) 


IS) 


OJ 

OI 


s 


(U 

e 

•H 
Eh 

en 

> 

-P 

•H 
O 
O 
rH 

> 


+J 

C 

•H 

o 


u 

CM 

Q) 
U 

0 


ID 


OJ 


§? 


OJ 
tS) 


81 


en 

CO 


03 
CO 


cu 


CO 


00 


Oj 


■** 


'M 


236 


•>j« 


\f\ 




:Mot 


Ol 


CD 


Ol 


U 

in 


0) 


CO 


la 


<Sl 


0) 
g 
•H 
Eh 

(0 

> 

>1 
4J 
•H 
U 
O 


•H 
O 
^3 


T3 
CN 

0) 

3 
Cn 

•H 


-j-      S         ^ 


OJ 


05 


ta 


cu 


j- 


Ul 


CO 
CD 


CU 


<T) 


LP 
OJ 


Qj 


.■IfT"* 


237 


--m 


■^:'^< 


in 


^ 


03 


cu 


en 


in 


n 


OJ 

00 


LD 


s 


0} 

s 

-H 
EH 

tn 

> 

■P 

•H 
O 
O 

rH 
<U 
> 


-P 

c 

•H 

o 

Id 


QJ 

CM 

• 

0) 
S-l 

en 
■H 
fa 


Qj 


T<' 


238 


in 


lO 


a       ^ 


j- 


cn 


03 


en 

ClJ 


CO 


ts> 


CO 


s 


sa 


•H 
&^ 

to 

> 

>i 
+> 
•H 
O 
O 
H 

5J 


■P 

a 

O 


<4-l 

0) 
U 

3 

•rj 


ClJ 


239 


cu 


U 
QJ 
LA 


CO 


0) 


W 


^ 


m 

CO 


S 


)S) 


cu 
cu 


_         <Sl 


<Sl 


IS» 


r— 1 

o 
> 

g 

n 
cu 

^ 

b] 

?^ 

g 

cn 

s 

§ 

± 

si 

U3 

cu 
2 

CU 

'"• 

cu 

1 

U3 
CU 

LL 

C 

(1) 

e 


> 

OJ 
cn 
(d 
4J 
H 
O 
> 

-P 


o 
■p 

-p 
u 

< 


(0 

ro 

3 

cn 

•H 
fa 


>4;»; 


240 


¥^1 


l-...:v: 


r  I 

I 

4 


cu 


U 

CD 

m 

CD 

C- 

QJ 

— ' 

E 

<J3 


?? 


en 

CO 


<a 


> 

nj 

C 


5 


IS) 


<S) 


CU 
CVJ 


SJ 


IS) 

>s> 


IS) 


?y      s      ?{]      s 


LO 
CU 


00 
CU 


IS) 

01 


Ul 

cu 


ID 

cn 

cu 

n 
I 


cn 
I 


5:^ 


e 

•H 

E-i 

> 

0) 
cn 
(0 
-P 
^-^ 
O 
> 

-P 

c 


CN 

i-t 

O 
■P 
to 

+J 
O 

< 


n 

CM 

(U 

3 

•H 

fa 


a 


^S^" 


241 


V' 


> 


o  ™ 

>  ui 

c:  ^ 

c 


u 

Oi 
in 


Q; 


IS) 


01 


CO 

J- 


cri 

CO 


ER        R]        "S 


CO 

ru 


CO 

I 


^ 


m 


LO 


s 


cu 


(1) 

g 

•H 
Eh 

CO 

> 

0) 

CI 

+) 

H 
O 
> 

-P 

3 

c 

H 


o 
-p 

-P 
O 


o 
m 

0) 

u 

3 
tn 

■nl 


*^H 


242 


^11 


> 

r— I 
O 


a. 
c 


^iihrt 


cu 


CD 


U 

0) 
Ln 


CD 


03 

LO 

• 

^^ 

(U 

6 

•H 

E-i 

S 

M 

• 

> 

^^ 

(U 

CT> 

(T3 

•4-1 

,^^ 

rH 

.^^ 

0 

• 

> 

•4J 

3 

a. 

c 

07 

H 

CO 

G) 

^ 

S^ 

0 

+J 

S 

(0 

3 

IS) 

4J 

O 

< 

J- 

n 

J- 

en 

• 

CN 

<Sl 

1X1 

OJ 

u 

OJ 

3 

Ol 

en 

IS> 


<S) 


nj 


cu 


en 


Ol 


# 


GO 
1 


CI 

ui 
ru 


Ol 

■a 


en 


CO 

n 
cu 


m 


fa 


243 


> 

in 

-(J 
■—I 
o 


C 





cu 


U 

QJ 

U1 

CO 

c^ 

QJ 

— 

E 

O} 

U) 

, 

Q) 

g 

•^ 

6* 

f^ 

to 

> 

-^ 

0) 

0» 

«> 

■p 

, 

iH 

•^ 

0 

• 

> 

•p 

3 

04 

c 

05 

H 

CO 

1 

(S 

in 

U 

0 

•P 

5 

• 

3 

<s> 

4J 

O 

< 

J- 

Q> 

J- 

CO 

W 

>a 

• 

vo 

0) 

h 

cu 

3 

cu 

0> 

<s> 

CO 


01 

m 


85        H? 


cu 


cu 
m 


I 


HI        83 


rn 


01 


CO 


IV 


^      s 


lO 
CO 


a 


T 

_* 


244 


oi 


> 


-t-> 


U 
QJ 


E 


tSl 


7^    S       ^        H5 


O) 


lO 


oi 


s 


CVJ 


0) 

en 
> 

0) 
CP 
nJ 
■P 

rH 

o 

> 

-p 

13 
&. 
C 


0) 

H 

CO 

<Sl 

vo 

(-1 

0 

4J 

5 

rt 

3 

IS) 

4J 

O 

< 

J- 

>w 

J- 

n 

• 

(N 

IS) 

• 

uj 

<U 

V4 

OJ 

3 

OI 

cn 

s> 

•H 

'>^^il 


245 


In  this  section,  comparisons  are  provided  in  an 
attempt  to  give  insight  to  the  system  response  when  several 
parameters  (amounts  of  disturbances)  are  varied.   However, 
it  should  be  kept  in  mind  that  the  overall  system  is 
18th  order,  coupled  and  nonlinear,  and  unexpected  variations 
in  the  transient  behavior  are  possible  and  may  not  be 
interpreted  easily.   In  all  simulations  system  stability 
is  preserved  under  all  the  simulated  disturbances,  the 
manipulator  tracked  the  desired  trajectories  and  steady 
state  error  is  eliminated  with  the  disturbance  rejection 
feature. 
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CHAPTER  7 
CONCLUSION 

Today's  industrial  manipulators  are  built  to  move 
slowly  or  the  joints  are  activated  one  by  one  to 
avoid  dynamic  interactions  between  links.   Typically  each 
link  is  modeled  as  a  second-order,  time-invariant  system 
and  the  joints  are  controlled  independently.   This  limited 
practice,  however,  does  not  take  full  advantage  of  the 
robot  technology.   Precision  remains  payload  and  task 
dependent,  even  instability  may  be  induced,  since  a  highly 
nonlinear  and  coupled  system  is  represented  by  a  linear, 
decoupled  system  and  a  sound  stability  analysis  is  not 

provided. 

This  work  addresses  the  tracking  problem  of  spatial, 
serial  manipulators  modeled  with  rigid  links.   Centralized 
adaptive  controllers  which  assure  the  global  asymptotic 
stability  of  the  system  are  given  via  the  second  method  of 
Lyapunov.   Actuator  dynamics  is  also  included  in  the 
system  model.   System  dynamics  is  represented  in  hand 
coordinates  and  it  is  shown  that  the  designed  controllers 
can  be  extended  for  this  system. 

The  kinetic  energy  expression  for  an  n-link, 
spatial  manipulator  is  obtained  and  the  Lagrange  equations 
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are  utilized  in  deriving  the  dynamic  equations.   These 
equations  form  a  set  of  2n,  nonlinear,  coupled,  first-order 
ordinary  differential  equations  for  an  n-link,  n  degree-of- 
freedom  arm.   In  general,  they  are  formed  and  the  forward 
or  the  inverse  problems  are  solved  numerically  on  digital 

computers . 

The  plant,  which  represents  the  actual  manipulator, 
and  the  reference  model  representing  the  ideal  robot  are 
both  expressed  as  nonlinear,  coupled  systems.   Error-driven 
system  dynamics  is  then  given  and  the  controllers  which 
yield  globally  asymptotically  stable  systems  are  designed 
using  Lyapunov ' s  second  method.   It  is  shown  that  the 
resulting  closed-loop  systems  are  also  asymptotically 
hyperstable.   Integral  feedback  is  added  to  compensate  for 
the  steady  state  system  disturbances.   System  dynamics 
is  expressed  in  hand  coordinates  and  an  adaptive  control 
law  scheme  is  proposed  for  this  model.   Actuator  dynamics, 
modeled  as  third-order,  linear,  time-invariant  systems, 
is  coupled  with  the  manipulator  dynamics  and  a  nonlinear 
state  transformation  is  introduced  to  facilitate  the 
controller  design.   This  transformation  increased  the 
computational  requirements  and  necessitated  the  measurements 
of  joint  accelerations.   Neglecting  armature  inductances, 
simplified  actuator  dynamics  is  obtained.   Each  actuator 
is  then  modeled  as  a  second-order,  linear,  time-invariant 
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system.   Joint  acceleration  measurements  and  the  added 
computations  are  thus  avoided.   Adaptive  controller  design 
and  the  disturbance  rejection  feature  are  applied  to  this 
system. 

Adaptive  controllers  are  implemented  on  the  computer 
for  n-link  robot  manipulators  powered  with  n  actuators. 
Examples  on  3-  and  6-link,  spatial,  industrial  manipulators 
are  presented.   Disturbances  acting  on  the  plant  are 
simulated  by  the  discrepancy  in  manipulator  and  actuator 
parameters  of  the  plant  and  reference  model,  difference  in 
initial  positions,  measurement  delays  and  the  delay  in 
control  law  implementation.   In  all  cases  system  stability 
is  preserved,  reference  trajectory  is  tracked,  and  steady- 
i  state  error  is  eliminated  with  the  disturbance  rejection 

feature. 

The  amount  of  discrepancy  between  the  plant  and  the 
reference  model  parameters  which  will  deteriorate  the  system 
response  or  even  induce  instability  need  to  be  further 
addressed.   Structural  flexibility  should  also  be  included 
in  the  dynamic  modeling  of  manipulators.   This  aspect  may 
be  omitted  until  a  mature  understanding  of  the  control 
problem  with  rigid  body  model  is  established,  since 
flexibility  further  complicates  the  dynamic  equations  and 
increases  the  system  dimensionality.   Although  computer 
simulations  indicate  the  validity  of  controllers  and  form 
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an  inexpensive  test  base,  ultimately  experimental 
implementation  on  actual  robots  must  be  realized. 

Advanced  controllers  call  for  on-line  use  of 
computers,  but  considering  that  the  current  industrial 
robots  already  have  computers  on  board  and  that 
microcomputer  prices  are  steadily  coming  down  with 
increased  memory  and  faster  operations,  industrial  use  of 
these  controllers  ia  feasible  if  reliable,  precise  and 
fast  operation  of  manipulators  is  required.   These 
desirable  features  will  force  manipulator  productivity  to 
its  full  capacity.   Although  the  flexibility  of  manipulators 
to  work  in  different  operations  (against  hard  automation) 
is  the  key  issue  to  make  them  attractive,  current  practices 
concentrate  on  the  dedicated  use  of  robots  partly  because 
of  their  slow  and  unreliable  features.   With  the  improved 
operation  speed  and  reliability,  flexibility  of  robots  can 
truly  be  realized.   Price  increase  of  the  complete  robot 
unit  (due  to  increased  computer  support)  will  be 
compensated  by  the  increased  productivity.   Finally,  if 
reliability  is  proven,  hesitancy  in  investment,  currently 
the  major  drawback,  will  be  overcome. 
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